remove unused files

[flightgear.git] / src / FDM / JSBSim / input_output / FGGroundCallback.cpp

diff --git a/src/FDM/JSBSim/input_output/FGGroundCallback.cpp b/src/FDM/JSBSim/input_output/FGGroundCallback.cpp
index a0236a2d7c70500a3d3a4d49915ea2cc79280f8d..8933101ca2b196926228bf63ebbf3bd44f65f1e0 100644 (file)
--- a/src/FDM/JSBSim/input_output/FGGroundCallback.cpp
+++ b/src/FDM/JSBSim/input_output/FGGroundCallback.cpp
@@ -31,8 +31,8 @@ HISTORY
 SENTRY
 %%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%*/
 
-#include <math/FGColumnVector3.h>
-#include <math/FGLocation.h>
+#include "math/FGColumnVector3.h"
+#include "math/FGLocation.h"
 #include "FGGroundCallback.h"
 
 namespace JSBSim {
@@ -41,7 +41,14 @@ namespace JSBSim {
 
 FGGroundCallback::FGGroundCallback()
 {
-  mReferenceRadius = 20925650.0;
+  mReferenceRadius = 20925650.0; // Sea level radius
+}
+
+//%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
+
+FGGroundCallback::FGGroundCallback(double ReferenceRadius)
+{
+  mReferenceRadius = ReferenceRadius;
 }
 
 //%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
@@ -61,13 +68,15 @@ double FGGroundCallback::GetAltitude(const FGLocation& loc) const
 
 double FGGroundCallback::GetAGLevel(double t, const FGLocation& loc,
                                     FGLocation& contact, FGColumnVector3& normal,
-                                    FGColumnVector3& vel) const
+                                    FGColumnVector3& vel, FGColumnVector3& angularVel) const
 {
   vel = FGColumnVector3(0.0, 0.0, 0.0);
-  normal = (-1/FGColumnVector3(loc).Magnitude())*FGColumnVector3(loc);
-  double radius = loc.GetRadius();
-  double agl = GetAltitude(loc);
-  contact = ((radius-agl)/radius)*FGColumnVector3(loc);
+  angularVel = FGColumnVector3(0.0, 0.0, 0.0);
+  normal = FGColumnVector3(loc).Normalize();
+  double loc_radius = loc.GetRadius();  // Get the radius of the given location
+                                        // (e.g. the CG)
+  double agl = loc_radius - mReferenceRadius;
+  contact = (mReferenceRadius/loc_radius)*FGColumnVector3(loc);
   return agl;
 }