1 /*%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
7 ------------- Copyright (C) 1999 Jon S. Berndt (jsb@hal-pc.org) -------------
9 This program is free software; you can redistribute it and/or modify it under
10 the terms of the GNU General Public License as published by the Free Software
11 Foundation; either version 2 of the License, or (at your option) any later
14 This program is distributed in the hope that it will be useful, but WITHOUT
15 ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or FITNESS
16 FOR A PARTICULAR PURPOSE. See the GNU General Public License for more
19 You should have received a copy of the GNU General Public License along with
20 this program; if not, write to the Free Software Foundation, Inc., 59 Temple
21 Place - Suite 330, Boston, MA 02111-1307, USA.
23 Further information about the GNU General Public License can also be found on
24 the world wide web at http://www.gnu.org.
27 --------------------------------------------------------------------------------
30 %%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
32 %%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%*/
37 /*%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
39 %%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%*/
44 /*%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
46 %%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%*/
48 #define ID_POSITION "$Id$"
50 /*%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
52 %%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%*/
54 /*%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
55 COMMENTS, REFERENCES, and NOTES
56 %%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%*/
58 /*%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
60 %%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%*/
62 /** Models the lateral and longitudinal translational EOM.
67 /*%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
69 %%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%*/
71 class FGPosition : public FGModel {
74 @param Executive a pointer to the parent executive object */
75 FGPosition(FGFDMExec*);
79 /** Runs the Position model; called by the Executive
80 @see JSBSim.cpp documentation
81 @return false if no error */
84 inline FGColumnVector GetVel(void) { return vVel; }
85 inline FGColumnVector GetVelDot(void) { return vVelDot; }
86 inline FGColumnVector GetUVW(void) { return vUVW; }
87 inline double GetVn(void) { return vVel(eX); }
88 inline double GetVe(void) { return vVel(eY); }
89 inline double GetVd(void) { return vVel(eZ); }
90 inline double GetVground(void) { return Vground; }
91 inline double GetGroundTrack(void) { return psigt; }
92 inline double Geth(void) { return h; }
93 inline double Gethdot(void) { return RadiusDot; }
94 inline double GetLatitude(void) { return Latitude; }
95 inline double GetLatitudeDot(void) { return LatitudeDot; }
96 inline double GetLongitude(void) { return Longitude; }
97 inline double GetLongitudeDot(void) { return LongitudeDot; }
98 inline double GetRunwayRadius(void) { return RunwayRadius; }
99 inline double GetDistanceAGL(void) { return DistanceAGL; }
100 inline double GetRadius(void) { return Radius; }
101 inline FGColumnVector GetRunwayNormal(void) { return vRunwayNormal; }
103 inline double GetGamma(void) { return gamma; }
104 inline void SetGamma(float tt) { gamma = tt; }
105 inline double GetHOverB(void) { return hoverb; }
106 void SetvVel(const FGColumnVector& v) { vVel = v; }
107 void SetLatitude(float tt) { Latitude = tt; }
108 void SetLongitude(double tt) { Longitude = tt; }
109 void Seth(double tt);
110 void SetRunwayRadius(double tt) { RunwayRadius = tt; }
111 void SetSeaLevelRadius(double tt) { SeaLevelRadius = tt;}
112 void SetDistanceAGL(double tt);
113 inline void SetRunwayNormal(double fgx, double fgy, double fgz ) {
114 vRunwayNormal << fgx << fgy << fgz;
120 FGColumnVector vVelDot;
121 FGColumnVector vRunwayNormal;
123 double Vee, invMass, invRadius;
125 double LatitudeDot, LongitudeDot, RadiusDot;
126 double lastLatitudeDot, lastLongitudeDot, lastRadiusDot;
127 double Longitude, Latitude;
131 double SeaLevelRadius;
142 //%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%