JSBSim updates. This update changes the file format, so an update of the base

[flightgear.git] / src / FDM / JSBSim / FGTranslation.cpp

diff --git a/src/FDM/JSBSim/FGTranslation.cpp b/src/FDM/JSBSim/FGTranslation.cpp
index 4223e557a24151280d905660647d4adc3852b929..9cdaf9e4ff391f5717c8085ab72c923be29ae91f 100644 (file)
--- a/src/FDM/JSBSim/FGTranslation.cpp
+++ b/src/FDM/JSBSim/FGTranslation.cpp
@@ -82,10 +82,18 @@ FGTranslation::FGTranslation(FGFDMExec* fdmex) : FGModel(fdmex)
 {
   Name = "FGTranslation";
   qbar = 0;
+  qbarUW = 0.0;
+  qbarUV = 0.0;
   Vt = 0.0;
   Mach = 0.0;
   alpha = beta = 0.0;
   adot = bdot = 0.0;
+
+  vUVWdot.InitMatrix();
+  vUVWdot_prev[0].InitMatrix();
+  vUVWdot_prev[1].InitMatrix();
+  vUVWdot_prev[2].InitMatrix();
+
   bind();
   Debug(0);
 }
@@ -102,8 +110,6 @@ FGTranslation::~FGTranslation(void)
 
 bool FGTranslation::Run(void)
 {
-  double Tc = 0.5*State->Getdt()*rate;
-
   if (!FGModel::Run()) {
 
     mVel(1,1) =  0.0;
@@ -118,7 +124,7 @@ bool FGTranslation::Run(void)
 
     vUVWdot = mVel*Rotation->GetPQR() + Aircraft->GetBodyAccel();
 
-    vUVW += Tc*(vUVWdot + vlastUVWdot);
+    vUVW += State->Integrate(FGState::TRAPZ, State->Getdt()*rate, vUVWdot, vUVWdot_prev);
 
     vAeroUVW = vUVW + State->GetTl2b()*Atmosphere->GetWindNED();
 
@@ -149,10 +155,10 @@ bool FGTranslation::Run(void)
     }
 
     qbar = 0.5*Atmosphere->GetDensity()*Vt*Vt;
+    qbarUW = 0.5*Atmosphere->GetDensity()*(vAeroUVW(eU)*vAeroUVW(eU) + vAeroUVW(eW)*vAeroUVW(eW));
+    qbarUV = 0.5*Atmosphere->GetDensity()*(vAeroUVW(eU)*vAeroUVW(eU) + vAeroUVW(eV)*vAeroUVW(eV));
     Mach = Vt / State->Geta();
 
-    vlastUVWdot = vUVWdot;
-
     if (debug_lvl > 1) Debug(1);
 
     return false;
@@ -165,30 +171,31 @@ bool FGTranslation::Run(void)
 
 void FGTranslation::bind(void)
 {
+  typedef double (FGTranslation::*PMF)(int) const;
   PropertyManager->Tie("velocities/u-fps", this,1,
-                       &FGTranslation::GetUVW /*,
+                       (PMF)&FGTranslation::GetUVW /*,
                        &FGTranslation::SetUVW,
                        true */);
   PropertyManager->Tie("velocities/v-fps", this,2,
-                       &FGTranslation::GetUVW /*,
+                       (PMF)&FGTranslation::GetUVW /*,
                        &FGTranslation::SetUVW,
                        true*/);
   PropertyManager->Tie("velocities/w-fps", this,3,
-                       &FGTranslation::GetUVW /*,
+                       (PMF)&FGTranslation::GetUVW /*,
                        &FGTranslation::SetUVW,
                        true*/);
   PropertyManager->Tie("accelerations/udot-fps", this,1,
-                       &FGTranslation::GetUVWdot);
+                       (PMF)&FGTranslation::GetUVWdot);
   PropertyManager->Tie("accelerations/vdot-fps", this,2,
-                       &FGTranslation::GetUVWdot);
+                       (PMF)&FGTranslation::GetUVWdot);
   PropertyManager->Tie("accelerations/wdot-fps", this,3,
-                       &FGTranslation::GetUVWdot);
+                       (PMF)&FGTranslation::GetUVWdot);
   PropertyManager->Tie("velocities/u-aero-fps", this,1,
-                       &FGTranslation::GetAeroUVW);
+                       (PMF)&FGTranslation::GetAeroUVW);
   PropertyManager->Tie("velocities/v-aero-fps", this,2,
-                       &FGTranslation::GetAeroUVW);
+                       (PMF)&FGTranslation::GetAeroUVW);
   PropertyManager->Tie("velocities/w-aero-fps", this,3,
-                       &FGTranslation::GetAeroUVW);
+                       (PMF)&FGTranslation::GetAeroUVW);
   PropertyManager->Tie("aero/alpha-rad", this,
                        &FGTranslation::Getalpha,
                        &FGTranslation::Setalpha,
@@ -203,6 +210,14 @@ void FGTranslation::bind(void)
                        &FGTranslation::Getqbar,
                        &FGTranslation::Setqbar,
                        true);
+  PropertyManager->Tie("aero/qbarUW-psf", this,
+                       &FGTranslation::GetqbarUW,
+                       &FGTranslation::SetqbarUW,
+                       true);
+  PropertyManager->Tie("aero/qbarUV-psf", this,
+                       &FGTranslation::GetqbarUV,
+                       &FGTranslation::SetqbarUV,
+                       true);
   PropertyManager->Tie("velocities/vt-fps", this,
                        &FGTranslation::GetVt,
                        &FGTranslation::SetVt,
@@ -237,6 +252,8 @@ void FGTranslation::unbind(void)
   PropertyManager->Untie("aero/alpha-rad");
   PropertyManager->Untie("aero/beta-rad");
   PropertyManager->Untie("aero/qbar-psf");
+  PropertyManager->Untie("aero/qbarUW-psf");
+  PropertyManager->Untie("aero/qbarUV-psf");
   PropertyManager->Untie("velocities/vt-fps");
   PropertyManager->Untie("velocities/mach-norm");
   PropertyManager->Untie("aero/alphadot-rad_sec");