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 "$Header$"
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 Geth(void) { return h; }
92 inline double Gethdot(void) { return RadiusDot; }
93 inline double GetLatitude(void) { return Latitude; }
94 inline double GetLatitudeDot(void) { return LatitudeDot; }
95 inline double GetLongitude(void) { return Longitude; }
96 inline double GetLongitudeDot(void) { return LongitudeDot; }
97 inline double GetRunwayRadius(void) { return RunwayRadius; }
98 inline double GetDistanceAGL(void) { return DistanceAGL; }
99 inline FGColumnVector GetRunwayNormal(void) { return vRunwayNormal; }
101 inline double GetGamma(void) { return gamma; }
102 inline void SetGamma(float tt) { gamma = tt; }
103 inline double GetHOverB(void) { return hoverb; }
104 void SetvVel(const FGColumnVector& v) { vVel = v; }
105 void SetLatitude(float tt) { Latitude = tt; }
106 void SetLongitude(double tt) { Longitude = tt; }
107 void Seth(double tt);
108 void SetRunwayRadius(double tt) { RunwayRadius = tt; }
109 void SetSeaLevelRadius(double tt) { SeaLevelRadius = tt;}
110 void SetDistanceAGL(double tt);
111 inline void SetRunwayNormal(double fgx, double fgy, double fgz ) {
112 vRunwayNormal << fgx << fgy << fgz;
118 FGColumnVector vVelDot;
119 FGColumnVector vRunwayNormal;
121 double Vee, invMass, invRadius;
123 double LatitudeDot, LongitudeDot, RadiusDot;
124 double lastLatitudeDot, lastLongitudeDot, lastRadiusDot;
125 double Longitude, Latitude;
129 double SeaLevelRadius;
139 //%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%