{
Name = "FGMassBalance";
- if (debug_lvl & 2) cout << "Instantiated: FGMassBalance" << endl;
+ Debug(0);
}
//%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
FGMassBalance::~FGMassBalance()
{
- if (debug_lvl & 2) cout << "Destroyed: FGMassBalance" << endl;
+ Debug(1);
}
//%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
{
if (!FGModel::Run()) {
- Weight = EmptyWeight + Propulsion->GetTanksWeight();
+ Weight = EmptyWeight + Propulsion->GetTanksWeight() + GetPointMassWeight();
- Mass = Weight / GRAVITY;
+ Mass = Weight / Inertial->gravity();
// Calculate new CG here.
- vXYZcg = (Propulsion->GetTanksCG() + EmptyWeight*vbaseXYZcg) / Weight;
+ vXYZcg = (Propulsion->GetTanksCG() + EmptyWeight*vbaseXYZcg
+ + GetPointMassCG() ) / Weight;
// Calculate new moments of inertia here
- Ixx = baseIxx + Propulsion->GetTanksIxx(vXYZcg);
- Iyy = baseIyy + Propulsion->GetTanksIyy(vXYZcg);
- Izz = baseIzz + Propulsion->GetTanksIzz(vXYZcg);
- Ixz = baseIxz + Propulsion->GetTanksIxz(vXYZcg);
+ Ixx = baseIxx + Propulsion->GetTanksIxx(vXYZcg) + GetPMIxx();
+ Iyy = baseIyy + Propulsion->GetTanksIyy(vXYZcg) + GetPMIyy();
+ Izz = baseIzz + Propulsion->GetTanksIzz(vXYZcg) + GetPMIzz();
+ Ixy = baseIxy + Propulsion->GetTanksIxy(vXYZcg) + GetPMIxy();
+ Ixz = baseIxz + Propulsion->GetTanksIxz(vXYZcg) + GetPMIxz();
- if (debug_lvl > 1) Debug();
+ Debug(2);
return false;
} else {
//%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
-void FGMassBalance::Debug(void)
+void FGMassBalance::AddPointMass(double weight, double X, double Y, double Z)
{
- if (debug_lvl & 16) { // Sanity check variables
- if (EmptyWeight <= 0.0 || EmptyWeight > 1e9)
- cout << "MassBalance::EmptyWeight out of bounds: " << EmptyWeight << endl;
- if (Weight <= 0.0 || Weight > 1e9)
- cout << "MassBalance::Weight out of bounds: " << Weight << endl;
- if (Mass <= 0.0 || Mass > 1e9)
- cout << "MassBalance::Mass out of bounds: " << Mass << endl;
+ PointMassLoc.push_back(*(new FGColumnVector3(X, Y, Z)));
+ PointMassWeight.push_back(weight);
+}
+
+//%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
+
+double FGMassBalance::GetPointMassWeight(void)
+{
+ double PM_total_weight = 0.0;
+
+ for (unsigned int i=0; i<PointMassWeight.size(); i++) {
+ PM_total_weight += PointMassWeight[i];
+ }
+ return PM_total_weight;
+}
+
+//%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
+
+FGColumnVector3& FGMassBalance::GetPointMassCG(void)
+{
+ PointMassCG.InitMatrix();
+
+ for (unsigned int i=0; i<PointMassLoc.size(); i++) {
+ PointMassCG += PointMassWeight[i]*PointMassLoc[i];
+ }
+ return PointMassCG;
+}
+
+//%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
+
+double FGMassBalance::GetPMIxx(void)
+{
+ double I = 0.0;
+ for (unsigned int i=0; i<PointMassLoc.size(); i++) {
+ I += PointMassLoc[i](eX)*PointMassLoc[i](eX)*PointMassWeight[i];
+ }
+ I /= (144.0*Inertial->gravity());
+ return I;
+}
+
+//%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
+
+double FGMassBalance::GetPMIyy(void)
+{
+ double I = 0.0;
+ for (unsigned int i=0; i<PointMassLoc.size(); i++) {
+ I += PointMassLoc[i](eY)*PointMassLoc[i](eY)*PointMassWeight[i];
+ }
+ I /= (144.0*Inertial->gravity());
+ return I;
+}
+
+//%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
+
+double FGMassBalance::GetPMIzz(void)
+{
+ double I = 0.0;
+ for (unsigned int i=0; i<PointMassLoc.size(); i++) {
+ I += PointMassLoc[i](eZ)*PointMassLoc[i](eZ)*PointMassWeight[i];
+ }
+ I /= (144.0*Inertial->gravity());
+ return I;
+}
+
+//%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
+
+double FGMassBalance::GetPMIxy(void)
+{
+ double I = 0.0;
+ for (unsigned int i=0; i<PointMassLoc.size(); i++) {
+ I += PointMassLoc[i](eX)*PointMassLoc[i](eY)*PointMassWeight[i];
+ }
+ I /= (144.0*Inertial->gravity());
+ return I;
+}
+
+//%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
+
+double FGMassBalance::GetPMIxz(void)
+{
+ double I = 0.0;
+ for (unsigned int i=0; i<PointMassLoc.size(); i++) {
+ I += PointMassLoc[i](eX)*PointMassLoc[i](eZ)*PointMassWeight[i];
+ }
+ I /= (144.0*Inertial->gravity());
+ return I;
+}
+
+//%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
+// 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 FGMassBalance::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: FGPiston" << endl;
+ if (from == 1) cout << "Destroyed: FGPiston" << 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 (from == 2) {
+ if (EmptyWeight <= 0.0 || EmptyWeight > 1e9)
+ cout << "MassBalance::EmptyWeight out of bounds: " << EmptyWeight << endl;
+ if (Weight <= 0.0 || Weight > 1e9)
+ cout << "MassBalance::Weight out of bounds: " << Weight << endl;
+ if (Mass <= 0.0 || Mass > 1e9)
+ cout << "MassBalance::Mass out of bounds: " << Mass << endl;
+ }
+ }
+ if (debug_lvl & 64) {
+ if (from == 0) { // Constructor
+ cout << IdSrc << endl;
+ cout << IdHdr << endl;
+ }
}
}
projects / flightgear.git / blobdiff