%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%*/
#include "FGModel.h"
-#include <math/FGColumnVector3.h>
-#include <math/FGMatrix33.h>
-#include <input_output/FGXMLElement.h>
+#include "math/FGColumnVector3.h"
+#include "math/FGMatrix33.h"
+#include "input_output/FGXMLElement.h"
#include <vector>
+#include <string>
/*%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
DEFINITIONS
%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%*/
-#define ID_MASSBALANCE "$Id$"
+#define ID_MASSBALANCE "$Id: FGMassBalance.h,v 1.27 2011/11/09 21:58:26 bcoconni Exp $"
/*%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
FORWARD DECLARATIONSS
%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%*/
+using std::string;
+
namespace JSBSim {
/*%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
/** Models weight, balance and moment of inertia information. Maintains a vector
of point masses. Sums the contribution of all, and provides this to FGPropagate.
- Loads the \<mass_balance> section of the aircraft configuration file.
+ Loads the \<mass_balance> section of the aircraft configuration file. There
+ can be any number of <pointmasses>. Each can also have a shape which - if
+ present - causes an associated moment of inertia to be calculated based on
+ the shape. Note that a cylinder is solid, a tube is hollow, a ball is solid
+ and a sphere is hollow.
<h3>Configuration File Format:</h3>
@code
<ixz unit="{SLUG*FT2 | KG*M2}"> {number} </ixz>
<iyz unit="{SLUG*FT2 | KG*M2}"> {number} </iyz>
<emptywt unit="{LBS | KG"> {number} </emptywt>
- <location name="CG" unit="{IN | M}">
+ <location name="CG" unit="{IN | FT | M}">
<x> {number} </x>
<y> {number} </y>
<z> {number} </z>
</location>
- <pointmass name="{string}">
+ [<pointmass name="{string}">
+ <form shape="{tube | cylinder | sphere | ball}">
+ <radius unit="{IN | FT | M}"> {number} </radius>
+ <length unit="{IN | FT | M}"> {number} </length>
+ </form>
<weight unit="{LBS | KG}"> {number} </weight>
- <location name="POINTMASS" unit="{IN | M}">
+ <location name="{string}" unit="{IN | FT | M}">
<x> {number} </x>
<y> {number} </y>
<z> {number} </z>
</location>
</pointmass>
- ... other point masses ...
+ ... other point masses ...]
</mass_balance>
@endcode
*/
bool Load(Element* el);
bool InitModel(void);
- bool Run(void);
+ /** Runs the Mass Balance model; called by the Executive
+ Can pass in a value indicating if the executive is directing the simulation to Hold.
+ @param Holding if true, the executive has been directed to hold the sim from
+ advancing time. Some models may ignore this flag, such as the Input
+ model, which may need to be active to listen on a socket for the
+ "Resume" command to be given.
+ @return false if no error */
+ bool Run(bool Holding);
double GetMass(void) const {return Mass;}
double GetWeight(void) const {return Weight;}
- FGColumnVector3& GetXYZcg(void) {return vXYZcg;}
+ double GetEmptyWeight(void) const {return EmptyWeight;}
+ const FGColumnVector3& GetXYZcg(void) const {return vXYZcg;}
double GetXYZcg(int axis) const {return vXYZcg(axis);}
- FGColumnVector3& GetDeltaXYZcg(void) {return vDeltaXYZcg;}
+ const FGColumnVector3& GetDeltaXYZcg(void) const {return vDeltaXYZcg;}
double GetDeltaXYZcg(int axis) const {return vDeltaXYZcg(axis);}
/** Computes the inertia contribution of a pointmass.
slugs at the given vector r in the structural frame. The units
should be for the mass in slug and the vector in the structural
frame as usual in inches.
- @param slugs the mass of this single pointmass given in slugs
+ @param mass_sl the mass of this single pointmass given in slugs
@param r the location of this single pointmass in the structural frame
*/
- FGMatrix33 GetPointmassInertia(double slugs, const FGColumnVector3& r) const
+ FGMatrix33 GetPointmassInertia(double mass_sl, const FGColumnVector3& r) const
{
FGColumnVector3 v = StructuralToBody( r );
- FGColumnVector3 sv = slugs*v;
+ FGColumnVector3 sv = mass_sl*v;
double xx = sv(1)*v(1);
double yy = sv(2)*v(2);
double zz = sv(3)*v(3);
*/
FGColumnVector3 StructuralToBody(const FGColumnVector3& r) const;
- inline void SetEmptyWeight(double EW) { EmptyWeight = EW;}
- inline void SetBaseCG(const FGColumnVector3& CG) {vbaseXYZcg = vXYZcg = CG;}
+ void SetEmptyWeight(double EW) { EmptyWeight = EW;}
+ void SetBaseCG(const FGColumnVector3& CG) {vbaseXYZcg = vXYZcg = CG;}
void AddPointMass(Element* el);
- double GetTotalPointMassWeight(void);
+ double GetTotalPointMassWeight(void) const;
- FGColumnVector3& GetPointMassMoment(void);
- FGMatrix33& GetJ(void) {return mJ;}
- FGMatrix33& GetJinv(void) {return mJinv;}
- void SetAircraftBaseInertias(FGMatrix33 BaseJ) {baseJ = BaseJ;}
+ const FGColumnVector3& GetPointMassMoment(void);
+ const FGMatrix33& GetJ(void) const {return mJ;}
+ const FGMatrix33& GetJinv(void) const {return mJinv;}
+ void SetAircraftBaseInertias(const FGMatrix33& BaseJ) {baseJ = BaseJ;}
+ void GetMassPropertiesReport(void) const;
+ struct Inputs {
+ double GasMass;
+ double TanksWeight;
+ FGColumnVector3 GasMoment;
+ FGMatrix33 GasInertia;
+ FGColumnVector3 TanksMoment;
+ FGMatrix33 TankInertia;
+ } in;
+
private:
double Weight;
double EmptyWeight;
FGColumnVector3 vbaseXYZcg;
FGColumnVector3 vPMxyz;
FGColumnVector3 PointMassCG;
- FGMatrix33& CalculatePMInertias(void);
+ const FGMatrix33& CalculatePMInertias(void);
+
+ /** The PointMass structure encapsulates a point mass object, moments of inertia
+ mass, location, etc. */
struct PointMass {
PointMass(double w, FGColumnVector3& vXYZ) {
Weight = w;
Location = vXYZ;
+ mPMInertia.InitMatrix();
+ Radius = 0.0;
+ Length = 0.0;
}
+
+ void CalculateShapeInertia(void) {
+ switch(eShapeType) {
+ case esTube:
+ mPMInertia(1,1) = (Weight/(slugtolb))*Radius*Radius; // mr^2
+ mPMInertia(2,2) = (Weight/(slugtolb*12))*(6*Radius*Radius + Length*Length);
+ mPMInertia(3,3) = mPMInertia(2,2);
+ break;
+ case esCylinder:
+ mPMInertia(1,1) = (Weight/(slugtolb*2))*Radius*Radius; // 0.5*mr^2
+ mPMInertia(2,2) = (Weight/(slugtolb*12))*(3*Radius*Radius + Length*Length);
+ mPMInertia(3,3) = mPMInertia(2,2);
+ break;
+ case esSphere:
+ mPMInertia(1,1) = (Weight/(slugtolb*3))*Radius*Radius*2; // (2mr^2)/3
+ mPMInertia(2,2) = mPMInertia(1,1);
+ mPMInertia(3,3) = mPMInertia(1,1);
+ case esBall:
+ mPMInertia(1,1) = (Weight/(slugtolb*5))*Radius*Radius*2; // (2mr^2)/5
+ mPMInertia(2,2) = mPMInertia(1,1);
+ mPMInertia(3,3) = mPMInertia(1,1);
+ break;
+ default:
+ break;
+ }
+ }
+
+ enum esShape {esUnspecified, esTube, esCylinder, esSphere, esBall} eShapeType;
FGColumnVector3 Location;
- double Weight;
+ double Weight; /// Weight in pounds.
+ double Radius; /// Radius in feet.
+ double Length; /// Length in feet.
+ string Name;
+ FGMatrix33 mPMInertia;
+
double GetPointMassLocation(int axis) const {return Location(axis);}
+ double GetPointMassWeight(void) const {return Weight;}
+ esShape GetShapeType(void) {return eShapeType;}
+ const FGColumnVector3& GetLocation(void) {return Location;}
+ const FGMatrix33& GetPointMassInertia(void) {return mPMInertia;}
+ const string& GetName(void) {return Name;}
+
void SetPointMassLocation(int axis, double value) {Location(axis) = value;}
void SetPointMassWeight(double wt) {Weight = wt;}
- double GetPointMassWeight(void) const {return Weight;}
+ void SetPointMassShapeType(esShape st) {eShapeType = st;}
+ void SetRadius(double r) {Radius = r;}
+ void SetLength(double l) {Length = l;}
+ void SetName(string name) {Name = name;}
+ double GetPointMassMoI(int r, int c) {return mPMInertia(r,c);}
- void bind(FGPropertyManager* PropertyManager, int num) {
- string tmp = CreateIndexedPropertyName("inertia/pointmass-weight-lbs", num);
- PropertyManager->Tie( tmp.c_str(), this, &PointMass::GetPointMassWeight,
- &PointMass::SetPointMassWeight);
-
- tmp = CreateIndexedPropertyName("inertia/pointmass-location-X-inches", num);
- PropertyManager->Tie( tmp.c_str(), this, eX, &PointMass::GetPointMassLocation,
- &PointMass::SetPointMassLocation);
- tmp = CreateIndexedPropertyName("inertia/pointmass-location-Y-inches", num);
- PropertyManager->Tie( tmp.c_str(), this, eY, &PointMass::GetPointMassLocation,
- &PointMass::SetPointMassLocation);
- tmp = CreateIndexedPropertyName("inertia/pointmass-location-Z-inches", num);
- PropertyManager->Tie( tmp.c_str(), this, eZ, &PointMass::GetPointMassLocation,
- &PointMass::SetPointMassLocation);
- }
+ void bind(FGPropertyManager* PropertyManager, int num);
};
- vector <struct PointMass*> PointMasses;
+ std::vector <struct PointMass*> PointMasses;
void bind(void);
void Debug(int from);
projects / flightgear.git / blobdiff