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() {
  31 }
  32
  33 FGAIBallistic::~FGAIBallistic() {
  34 }
  35
  36
  37 bool FGAIBallistic::init() {
  38    FGAIBase::init();
  39    vs = sin( elevation * 0.017453293 ) * speed;
  40    hs = cos( elevation * 0.017453293 ) * speed;
  41    aero_stabilized =  true;
  42    hdg = azimuth;
  43    pitch = elevation;
  44    return true;
  45 }
  46
  47 void FGAIBallistic::bind() {
  48     FGAIBase::bind();
  49 }
  50
  51 void FGAIBallistic::unbind() {
  52     FGAIBase::unbind();
  53 }
  54
  55 void FGAIBallistic::update(double dt) {
  56
  57    Run(dt);
  58    Transform();
  59    FGAIBase::update(dt);
  60 }
  61
  62
  63 void FGAIBallistic::setAzimuth(double az) {
  64    azimuth = az;
  65 }
  66
  67
  68 void FGAIBallistic::setElevation(double el) {
  69    elevation = el;
  70 }
  71
  72
  73 void FGAIBallistic::setStabilization(bool val) {
  74    aero_stabilized = val;
  75 }
  76
  77
  78 void FGAIBallistic::Run(double dt) {
  79
  80    double speed_north_deg_sec;
  81    double speed_east_deg_sec;
  82    double ft_per_deg_lon;
  83    double ft_per_deg_lat;
  84
  85    // get size of a degree at this latitude
  86    ft_per_deg_lat = 366468.96 - 3717.12 * cos(pos.lat() / 57.2958 );
  87    ft_per_deg_lon = 365228.16 * cos(pos.lat() / 57.2958);
  88
  89    // the two drag calculations below assume sea-level density,
  90    // mass of 0.03 slugs,  drag coeff of 0.295, frontal area of 0.007 ft2
  91    // adjust horizontal speed due to drag
  92    hs -= 0.000082 * hs * hs * dt;
  93    if ( hs < 0.0 ) hs = 0.0;
  94
  95    // adjust vertical speed due to drag
  96    if (vs > 0.0) {
  97      vs -= 0.000082 * vs * vs * dt;
  98    } else {
  99      vs += 0.000082 * vs * vs * dt;
 100    }
 101
 102    // convert horizontal speed (fps) to degrees per second
 103    speed_north_deg_sec = cos( hdg / 57.29577951 ) * hs / ft_per_deg_lat;
 104    speed_east_deg_sec  = sin( hdg / 57.29577951 ) * hs / ft_per_deg_lon;
 105
 106    // set new position
 107    pos.setlat( pos.lat() + speed_north_deg_sec * dt);
 108    pos.setlon( pos.lon() + speed_east_deg_sec * dt);
 109
 110    // adjust vertical speed for acceleration of gravity
 111    vs -= 32.17 * dt;
 112
 113    // adjust altitude (meters)
 114    altitude += vs * dt * 0.3048;
 115    pos.setelev(altitude);
 116
 117    // adjust pitch if aerostabilized
 118    if (aero_stabilized) pitch = atan2( vs, hs ) * 57.29577951;
 119
 120    // set destruction flag if altitude less than sea level -1000
 121    if (altitude < -1000.0) setDie(true);
 122
 123 }
 124