1 // FGAIBallistic - FGAIBase-derived class creates a ballistic object
3 // Written by David Culp, started November 2003.
4 // - davidculp2@comcast.net
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.
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.
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.
24 #include <simgear/math/point3d.hxx>
27 #include "AIBallistic.hxx"
30 FGAIBallistic::FGAIBallistic(FGAIManager* mgr) {
32 _type_str = "ballistic";
36 FGAIBallistic::~FGAIBallistic() {
40 bool FGAIBallistic::init() {
42 vs = sin( elevation * 0.017453293 ) * speed;
43 hs = cos( elevation * 0.017453293 ) * speed;
44 aero_stabilized = true;
50 void FGAIBallistic::bind() {
54 void FGAIBallistic::unbind() {
58 void FGAIBallistic::update(double dt) {
66 void FGAIBallistic::setAzimuth(double az) {
71 void FGAIBallistic::setElevation(double el) {
76 void FGAIBallistic::setStabilization(bool val) {
77 aero_stabilized = val;
81 void FGAIBallistic::Run(double dt) {
83 double speed_north_deg_sec;
84 double speed_east_deg_sec;
85 double ft_per_deg_lon;
86 double ft_per_deg_lat;
88 // get size of a degree at this latitude
89 ft_per_deg_lat = 366468.96 - 3717.12 * cos(pos.lat()/SG_RADIANS_TO_DEGREES);
90 ft_per_deg_lon = 365228.16 * cos(pos.lat() / SG_RADIANS_TO_DEGREES);
92 // the two drag calculations below assume sea-level density,
93 // mass of 0.03 slugs, drag coeff of 0.295, frontal area of 0.007 ft2
94 // adjust horizontal speed due to drag
95 hs -= 0.000082 * hs * hs * dt;
96 if ( hs < 0.0 ) hs = 0.0;
98 // adjust vertical speed due to drag
100 vs -= 0.000082 * vs * vs * dt;
102 vs += 0.000082 * vs * vs * dt;
105 // convert horizontal speed (fps) to degrees per second
106 speed_north_deg_sec = cos(hdg / SG_RADIANS_TO_DEGREES) * hs / ft_per_deg_lat;
107 speed_east_deg_sec = sin(hdg / SG_RADIANS_TO_DEGREES) * hs / ft_per_deg_lon;
110 pos.setlat( pos.lat() + speed_north_deg_sec * dt);
111 pos.setlon( pos.lon() + speed_east_deg_sec * dt);
113 // adjust vertical speed for acceleration of gravity
116 // adjust altitude (meters)
117 altitude += vs * dt * SG_FEET_TO_METER;
118 pos.setelev(altitude);
120 // adjust pitch if aerostabilized
121 if (aero_stabilized) pitch = atan2( vs, hs ) * SG_RADIANS_TO_DEGREES;
123 // set destruction flag if altitude less than sea level -1000
124 if (altitude < -1000.0) setDie(true);