src/AIModel/AIBallistic.cxx

   1 // FGAIBallistic - FGAIBase-derived class creates a ballistic object
   2 //
   3 // Written by David Culp, started November 2003.
   4 // - davidculp2@comcast.net
   5 //
   6 // This program is free software; you can redistribute it and/or
   7 // modify it under the terms of the GNU General Public License as
   8 // published by the Free Software Foundation; either version 2 of the
   9 // License, or (at your option) any later version.
  10 //
  11 // This program is distributed in the hope that it will be useful, but
  12 // WITHOUT ANY WARRANTY; without even the implied warranty of
  13 // MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
  14 // General Public License for more details.
  15 //
  16 // You should have received a copy of the GNU General Public License
  17 // along with this program; if not, write to the Free Software
  18 // Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
  19
  20 #ifdef HAVE_CONFIG_H
  21 #  include <config.h>
  22 #endif
  23
  24 #include <simgear/math/point3d.hxx>
  25 #include <math.h>
  26
  27 #include "AIBallistic.hxx"
  28
  29
  30 FGAIBallistic::FGAIBallistic(FGAIManager* mgr) {
  31     manager = mgr;
  32     _type_str = "ballistic";
  33     _otype = otBallistic;
  34     drag_area = 0.007;
  35 }
  36
  37 FGAIBallistic::~FGAIBallistic() {
  38 }
  39
  40
  41 bool FGAIBallistic::init() {
  42    FGAIBase::init();
  43    aero_stabilized =  true;
  44    hdg = azimuth;
  45    pitch = elevation;
  46    return true;
  47 }
  48
  49 void FGAIBallistic::bind() {
  50 //    FGAIBase::bind();
  51 }
  52
  53 void FGAIBallistic::unbind() {
  54 //    FGAIBase::unbind();
  55 }
  56
  57 void FGAIBallistic::update(double dt) {
  58    FGAIBase::update(dt);
  59    Run(dt);
  60    Transform();
  61 }
  62
  63
  64 void FGAIBallistic::setAzimuth(double az) {
  65    hdg = azimuth = az;
  66 }
  67
  68
  69 void FGAIBallistic::setElevation(double el) {
  70    pitch = elevation = el;
  71 }
  72
  73
  74 void FGAIBallistic::setStabilization(bool val) {
  75    aero_stabilized = val;
  76 }
  77
  78 void FGAIBallistic::setDragArea(double a) {
  79    drag_area = a;
  80 }
  81
  82 void FGAIBallistic::Run(double dt) {
  83
  84    double speed_north_deg_sec;
  85    double speed_east_deg_sec;
  86
  87    // the two drag calculations below assume sea-level density,
  88    // mass of 0.03 slugs,  drag coeff of 0.295
  89    // adjust speed due to drag
  90    speed -= 0.0116918 * drag_area * speed * speed * dt;
  91    if ( speed < 0.0 ) speed = 0.0;
  92    vs = sin( pitch * SG_DEGREES_TO_RADIANS ) * speed;
  93    hs = cos( pitch * SG_DEGREES_TO_RADIANS ) * speed;
  94
  95    // convert horizontal speed (fps) to degrees per second
  96    speed_north_deg_sec = cos(hdg / SG_RADIANS_TO_DEGREES) * hs / ft_per_deg_lat;
  97    speed_east_deg_sec  = sin(hdg / SG_RADIANS_TO_DEGREES) * hs / ft_per_deg_lon;
  98
  99    // set new position
 100    pos.setlat( pos.lat() + speed_north_deg_sec * dt);
 101    pos.setlon( pos.lon() + speed_east_deg_sec * dt);
 102
 103    // adjust altitude (feet)
 104    altitude += vs * dt;
 105    pos.setelev(altitude * SG_FEET_TO_METER);
 106
 107    // adjust vertical speed for acceleration of gravity
 108    vs -= 32.17 * dt;
 109
 110    // recalculate pitch (velocity vector) if aerostabilized
 111    if (aero_stabilized) pitch = atan2( vs, hs ) * SG_RADIANS_TO_DEGREES;
 112
 113    // recalculate total speed
 114    speed = sqrt( vs * vs + hs * hs);
 115
 116    // set destruction flag if altitude less than sea level -1000
 117    if (altitude < -1000.0) setDie(true);
 118
 119 }
 120