1 /*%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
3 Module: FGAerodynamics.cpp
6 Purpose: Encapsulates the aerodynamic forces (gear and collision)
8 ------------- Copyright (C) 2000 Jon S. Berndt (jsb@hal-pc.org) -------------
10 This program is free software; you can redistribute it and/or modify it under
11 the terms of the GNU General Public License as published by the Free Software
12 Foundation; either version 2 of the License, or (at your option) any later
15 This program is distributed in the hope that it will be useful, but WITHOUT
16 ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or FITNESS
17 FOR A PARTICULAR PURPOSE. See the GNU General Public License for more
20 You should have received a copy of the GNU General Public License along with
21 this program; if not, write to the Free Software Foundation, Inc., 59 Temple
22 Place - Suite 330, Boston, MA 02111-1307, USA.
24 Further information about the GNU General Public License can also be found on
25 the world wide web at http://www.gnu.org.
27 FUNCTIONAL DESCRIPTION
28 --------------------------------------------------------------------------------
31 --------------------------------------------------------------------------------
33 04/22/01 JSB Moved code into here from FGAircraft
35 %%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
37 %%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%*/
39 #include "FGAerodynamics.h"
40 #include "FGFactorGroup.h"
41 #include "FGCoefficient.h"
43 static const char *IdSrc = "$Id$";
44 static const char *IdHdr = ID_AERODYNAMICS;
46 /*%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
48 %%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%*/
51 FGAerodynamics::FGAerodynamics(FGFDMExec* FDMExec) : FGModel(FDMExec)
53 Name = "FGAerodynamics";
62 Coeff = new CoeffArray[6];
67 //%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
69 FGAerodynamics::~FGAerodynamics()
73 for (j=0; j<Coeff[i].size(); j++) {
82 //%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
84 bool FGAerodynamics::Run(void)
86 unsigned int axis_ctr,ctr;
88 if (!FGModel::Run()) {
93 for (axis_ctr = 0; axis_ctr < 3; axis_ctr++) {
94 for (ctr=0; ctr < Coeff[axis_ctr].size(); ctr++) {
95 vFs(axis_ctr+1) += Coeff[axis_ctr][ctr]->TotalValue();
98 //correct signs of drag and lift to wind axes convention
99 //positive forward, right, down
100 vFs(1)*=-1; vFs(3)*=-1;
101 //cout << "Aircraft::vFs: " << vFs << endl;
102 vForces = State->GetTs2b()*vFs;
104 vDXYZcg(eX) = -(Aircraft->GetXYZrp(eX)
105 - MassBalance->GetXYZcg(eX))*inchtoft;
106 vDXYZcg(eY) = (Aircraft->GetXYZrp(eY)
107 - MassBalance->GetXYZcg(eY))*inchtoft;
108 vDXYZcg(eZ) = -(Aircraft->GetXYZrp(eZ)
109 - MassBalance->GetXYZcg(eZ))*inchtoft;
111 vMoments = vDXYZcg*vForces; // M = r X F
113 for (axis_ctr = 0; axis_ctr < 3; axis_ctr++) {
114 for (ctr = 0; ctr < Coeff[axis_ctr+3].size(); ctr++) {
115 vMoments(axis_ctr+1) += Coeff[axis_ctr+3][ctr]->TotalValue();
124 //%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
126 bool FGAerodynamics::Load(FGConfigFile* AC_cfg)
130 AC_cfg->GetNextConfigLine();
132 while ((token = AC_cfg->GetValue()) != string("/AERODYNAMICS")) {
133 if (token == "AXIS") {
135 axis = AC_cfg->GetValue("NAME");
136 AC_cfg->GetNextConfigLine();
137 while ((token = AC_cfg->GetValue()) != string("/AXIS")) {
138 if( token == "COEFFICIENT" ) {
139 ca.push_back( new FGCoefficient(FDMExec) );
140 ca.back()->Load(AC_cfg);
141 cm[ca.back()->Getname()]=ca.back();
142 } else if ( token == "GROUP" ) {
143 ca.push_back( new FGFactorGroup(FDMExec) );
144 ca.back()->Load(AC_cfg);
145 cm[ca.back()->Getname()]=ca.back();
148 Coeff[AxisIdx[axis]] = ca;
149 AC_cfg->GetNextConfigLine();
156 //%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
158 string FGAerodynamics::GetCoefficientStrings(void)
160 string CoeffStrings = "";
161 bool firstime = true;
162 unsigned int axis, sd;
164 for (axis = 0; axis < 6; axis++) {
165 for (sd = 0; sd < Coeff[axis].size(); sd++) {
169 CoeffStrings += ", ";
171 CoeffStrings += Coeff[axis][sd]->GetCoefficientStrings();
177 //%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
179 string FGAerodynamics::GetCoefficientValues(void)
181 string SDValues = "";
182 bool firstime = true;
184 for (unsigned int axis = 0; axis < 6; axis++) {
185 for (unsigned int sd = 0; sd < Coeff[axis].size(); sd++) {
191 SDValues += Coeff[axis][sd]->GetCoefficientValues();
198 //%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
200 double FGAerodynamics::GetLoD(void)
202 if (vFs(1) != 0.00) return vFs(3)/vFs(1);
205 //%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
206 // The bitmasked value choices are as follows:
207 // unset: In this case (the default) JSBSim would only print
208 // out the normally expected messages, essentially echoing
209 // the config files as they are read. If the environment
210 // variable is not set, debug_lvl is set to 1 internally
211 // 0: This requests JSBSim not to output any messages
213 // 1: This value explicity requests the normal JSBSim
215 // 2: This value asks for a message to be printed out when
216 // a class is instantiated
217 // 4: When this value is set, a message is displayed when a
218 // FGModel object executes its Run() method
219 // 8: When this value is set, various runtime state variables
220 // are printed out periodically
221 // 16: When set various parameters are sanity checked and
222 // a message is printed out when they go out of bounds
224 void FGAerodynamics::Debug(int from)
226 if (debug_lvl <= 0) return;
228 if (debug_lvl & 1) { // Standard console startup message output
229 if (from == 0) { // Constructor
233 if (debug_lvl & 2 ) { // Instantiation/Destruction notification
234 if (from == 0) cout << "Instantiated: FGAerodynamics" << endl;
235 if (from == 1) cout << "Destroyed: FGAerodynamics" << endl;
237 if (debug_lvl & 4 ) { // Run() method entry print for FGModel-derived objects
239 if (debug_lvl & 8 ) { // Runtime state variables
241 if (debug_lvl & 16) { // Sanity checking
243 if (debug_lvl & 64) {
244 if (from == 0) { // Constructor
245 cout << IdSrc << endl;
246 cout << IdHdr << endl;