HISTORY
--------------------------------------------------------------------------------
09/13/00 JSB Created
+04/22/01 JSB Moved code into here from FGAircraft
%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
INCLUDES
%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%*/
#include "FGAerodynamics.h"
+#include "FGFactorGroup.h"
+#include "FGCoefficient.h"
-static const char *IdSrc = "$Header$";
+static const char *IdSrc = "$Id$";
static const char *IdHdr = ID_AERODYNAMICS;
/*%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%*/
-FGAerodynamics::FGAerodynamics(FGFDMExec* fgex) : FGModel(fgex)
+FGAerodynamics::FGAerodynamics(FGFDMExec* FDMExec) : FGModel(FDMExec)
{
+ Name = "FGAerodynamics";
+ AxisIdx["DRAG"] = 0;
+ AxisIdx["SIDE"] = 1;
+ AxisIdx["LIFT"] = 2;
+ AxisIdx["ROLL"] = 3;
+ AxisIdx["PITCH"] = 4;
+ AxisIdx["YAW"] = 5;
+
+ Coeff = new CoeffArray[6];
+
+ Debug(0);
+}
+
+//%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
+
+FGAerodynamics::~FGAerodynamics()
+{
+ unsigned int i,j;
+ for (i=0; i<6; i++) {
+ for (j=0; j<Coeff[i].size(); j++) {
+ delete Coeff[i][j];
+ }
+ }
+ delete[] Coeff;
+
+ Debug(1);
}
+//%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
-bool FGAerodynamics:: Run(void) {
+bool FGAerodynamics::Run(void)
+{
+ unsigned int axis_ctr,ctr;
if (!FGModel::Run()) {
+ vLastFs = vFs;
+ vFs.InitMatrix();
+
+ for (axis_ctr = 0; axis_ctr < 3; axis_ctr++) {
+ for (ctr=0; ctr < Coeff[axis_ctr].size(); ctr++) {
+ vFs(axis_ctr+1) += Coeff[axis_ctr][ctr]->TotalValue();
+ }
+ }
+ //correct signs of drag and lift to wind axes convention
+ //positive forward, right, down
+ vFs(1)*=-1; vFs(3)*=-1;
+ //cout << "Aircraft::vFs: " << vFs << endl;
+ vForces = State->GetTs2b()*vFs;
+
+ vDXYZcg(eX) = -(Aircraft->GetXYZrp(eX)
+ - MassBalance->GetXYZcg(eX))*inchtoft;
+ vDXYZcg(eY) = (Aircraft->GetXYZrp(eY)
+ - MassBalance->GetXYZcg(eY))*inchtoft;
+ vDXYZcg(eZ) = -(Aircraft->GetXYZrp(eZ)
+ - MassBalance->GetXYZcg(eZ))*inchtoft;
+
+ vMoments = vDXYZcg*vForces; // M = r X F
+
+ for (axis_ctr = 0; axis_ctr < 3; axis_ctr++) {
+ for (ctr = 0; ctr < Coeff[axis_ctr+3].size(); ctr++) {
+ vMoments(axis_ctr+1) += Coeff[axis_ctr+3][ctr]->TotalValue();
+ }
+ }
return false;
} else {
return true;
}
}
-bool FGAerodynamics::LoadAerodynamics(FGConfigFile* AC_cfg)
+//%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
+
+bool FGAerodynamics::Load(FGConfigFile* AC_cfg)
{
-//
+ string token, axis;
+
+ AC_cfg->GetNextConfigLine();
+
+ while ((token = AC_cfg->GetValue()) != string("/AERODYNAMICS")) {
+ if (token == "AXIS") {
+ CoeffArray ca;
+ axis = AC_cfg->GetValue("NAME");
+ AC_cfg->GetNextConfigLine();
+ while ((token = AC_cfg->GetValue()) != string("/AXIS")) {
+ if( token == "COEFFICIENT" ) {
+ ca.push_back( new FGCoefficient(FDMExec) );
+ ca.back()->Load(AC_cfg);
+ cm[ca.back()->Getname()]=ca.back();
+ } else if ( token == "GROUP" ) {
+ ca.push_back( new FGFactorGroup(FDMExec) );
+ ca.back()->Load(AC_cfg);
+ cm[ca.back()->Getname()]=ca.back();
+ }
+ }
+ Coeff[AxisIdx[axis]] = ca;
+ AC_cfg->GetNextConfigLine();
+ }
+ }
+
+ return true;
+}
+
+//%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
+
+string FGAerodynamics::GetCoefficientStrings(void)
+{
+ string CoeffStrings = "";
+ bool firstime = true;
+ unsigned int axis, sd;
+
+ for (axis = 0; axis < 6; axis++) {
+ for (sd = 0; sd < Coeff[axis].size(); sd++) {
+ if (firstime) {
+ firstime = false;
+ } else {
+ CoeffStrings += ", ";
+ }
+ CoeffStrings += Coeff[axis][sd]->GetCoefficientStrings();
+ }
+ }
+ return CoeffStrings;
+}
+
+//%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
+
+string FGAerodynamics::GetCoefficientValues(void)
+{
+ string SDValues = "";
+ bool firstime = true;
+
+ for (unsigned int axis = 0; axis < 6; axis++) {
+ for (unsigned int sd = 0; sd < Coeff[axis].size(); sd++) {
+ if (firstime) {
+ firstime = false;
+ } else {
+ SDValues += ", ";
+ }
+ SDValues += Coeff[axis][sd]->GetCoefficientValues();
+ }
+ }
+
+ return SDValues;
+}
+
+//%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
+
+double FGAerodynamics::GetLoD(void)
+{
+ if (vFs(1) != 0.00) return vFs(3)/vFs(1);
+ else return 0.00;
+}
+//%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
+// The bitmasked value choices are as follows:
+// unset: In this case (the default) JSBSim would only print
+// out the normally expected messages, essentially echoing
+// the config files as they are read. If the environment
+// variable is not set, debug_lvl is set to 1 internally
+// 0: This requests JSBSim not to output any messages
+// whatsoever.
+// 1: This value explicity requests the normal JSBSim
+// startup messages
+// 2: This value asks for a message to be printed out when
+// a class is instantiated
+// 4: When this value is set, a message is displayed when a
+// FGModel object executes its Run() method
+// 8: When this value is set, various runtime state variables
+// are printed out periodically
+// 16: When set various parameters are sanity checked and
+// a message is printed out when they go out of bounds
+
+void FGAerodynamics::Debug(int from)
+{
+ if (debug_lvl <= 0) return;
+
+ if (debug_lvl & 1) { // Standard console startup message output
+ if (from == 0) { // Constructor
+
+ }
+ }
+ if (debug_lvl & 2 ) { // Instantiation/Destruction notification
+ if (from == 0) cout << "Instantiated: FGAerodynamics" << endl;
+ if (from == 1) cout << "Destroyed: FGAerodynamics" << endl;
+ }
+ if (debug_lvl & 4 ) { // Run() method entry print for FGModel-derived objects
+ }
+ if (debug_lvl & 8 ) { // Runtime state variables
+ }
+ if (debug_lvl & 16) { // Sanity checking
+ }
+ if (debug_lvl & 64) {
+ if (from == 0) { // Constructor
+ cout << IdSrc << endl;
+ cout << IdHdr << endl;
+ }
+ }
}