+//%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
+
+void FGMassBalance::AddPointMass(double weight, double X, double Y, double Z)
+{
+ PointMassLoc.push_back(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::GetPointMassMoment(void)
+{
+ PointMassCG.InitMatrix();
+
+ for (unsigned int i=0; i<PointMassLoc.size(); i++) {
+ PointMassCG += PointMassWeight[i]*PointMassLoc[i];
+ }
+ return PointMassCG;
+}
+
+//%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
+
+FGMatrix33& FGMassBalance::CalculatePMInertias(void)
+{
+ unsigned int size;
+
+ size = PointMassLoc.size();
+ if (size == 0) return pmJ;
+
+ pmJ = FGMatrix33();
+
+ for (unsigned int i=0; i<size; i++)
+ pmJ += GetPointmassInertia( lbtoslug * PointMassWeight[i], PointMassLoc[i] );
+
+ return pmJ;
+}
+
+//%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
+
+FGColumnVector3 FGMassBalance::StructuralToBody(const FGColumnVector3& r) const
+{
+ // Under the assumption that in the structural frame the:
+ //
+ // - X-axis is directed afterwards,
+ // - Y-axis is directed towards the right,
+ // - Z-axis is directed upwards,
+ //
+ // (as documented in http://jsbsim.sourceforge.net/JSBSimCoordinates.pdf)
+ // we have to subtract first the center of gravity of the plane which
+ // is also defined in the structural frame:
+ //
+ // FGColumnVector3 cgOff = r - vXYZcg;
+ //
+ // Next, we do a change of units:
+ //
+ // cgOff *= inchtoft;
+ //
+ // And then a 180 degree rotation is done about the Y axis so that the:
+ //
+ // - X-axis is directed forward,
+ // - Y-axis is directed towards the right,
+ // - Z-axis is directed downward.
+ //
+ // This is needed because the structural and body frames are 180 degrees apart.
+
+ return FGColumnVector3(inchtoft*(vXYZcg(1)-r(1)),
+ inchtoft*(r(2)-vXYZcg(2)),
+ inchtoft*(vXYZcg(3)-r(3)));
+}
+
+//%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
+
+void FGMassBalance::bind(void)
+{
+ typedef double (FGMassBalance::*PMF)(int) const;
+ PropertyManager->Tie("inertia/mass-slugs", this,
+ &FGMassBalance::GetMass);
+ PropertyManager->Tie("inertia/weight-lbs", this,
+ &FGMassBalance::GetWeight);
+ PropertyManager->Tie("inertia/cg-x-ft", this,1,
+ (PMF)&FGMassBalance::GetXYZcg);
+ PropertyManager->Tie("inertia/cg-y-ft", this,2,
+ (PMF)&FGMassBalance::GetXYZcg);
+ PropertyManager->Tie("inertia/cg-z-ft", this,3,
+ (PMF)&FGMassBalance::GetXYZcg);
+}
+
+//%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
+
+void FGMassBalance::unbind(void)
+{
+ PropertyManager->Untie("inertia/mass-slugs");
+ PropertyManager->Untie("inertia/weight-lbs");
+ PropertyManager->Untie("inertia/cg-x-ft");
+ PropertyManager->Untie("inertia/cg-y-ft");
+ PropertyManager->Untie("inertia/cg-z-ft");
+}
+
+//%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
+// 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: FGMassBalance" << endl;
+ if (from == 1) cout << "Destroyed: FGMassBalance" << 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;
+ }
+ }
+}
+}