src/FDM/JSBSim/FGGroundCallback.cpp

   1 /*%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
   2
   3  Header:       FGGroundCallback.cpp
   4  Author:       Mathias Froehlich
   5  Date started: 05/21/04
   6
   7  ------ Copyright (C) 2004 Mathias Froehlich (Mathias.Froehlich@web.de) -------
   8
   9  This program is free software; you can redistribute it and/or modify it under
  10  the terms of the GNU General Public License as published by the Free Software
  11  Foundation; either version 2 of the License, or (at your option) any later
  12  version.
  13
  14  This program is distributed in the hope that it will be useful, but WITHOUT
  15  ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or FITNESS
  16  FOR A PARTICULAR PURPOSE.  See the GNU General Public License for more
  17  details.
  18
  19  You should have received a copy of the GNU General Public License along with
  20  this program; if not, write to the Free Software Foundation, Inc., 59 Temple
  21  Place - Suite 330, Boston, MA  02111-1307, USA.
  22
  23  Further information about the GNU General Public License can also be found on
  24  the world wide web at http://www.gnu.org.
  25
  26 HISTORY
  27 -------------------------------------------------------------------------------
  28 05/21/00   MF   Created
  29
  30 %%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
  31 SENTRY
  32 %%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%*/
  33
  34 #ifdef HAVE_CONFIG_H
  35 #include <config.h>
  36 #endif
  37
  38 #include "FGColumnVector3.h"
  39 #include "FGLocation.h"
  40 #include "FGGroundCallback.h"
  41
  42 namespace JSBSim {
  43
  44 //%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
  45
  46 FGGroundCallback::FGGroundCallback()
  47 {
  48   mReferenceRadius = 20925650;
  49 }
  50
  51 //%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
  52
  53 FGGroundCallback::~FGGroundCallback()
  54 {
  55 }
  56
  57 //%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
  58
  59 double FGGroundCallback::GetAltitude(const FGLocation& l) const
  60 {
  61   return l.GetRadius() - mReferenceRadius;
  62 }
  63
  64 //%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
  65
  66 double FGGroundCallback::GetAGLevel(double t, const FGLocation& l,
  67                                     FGLocation& cont, FGColumnVector3& n,
  68                                     FGColumnVector3& v) const
  69 {
  70   v = FGColumnVector3(0.0, 0.0, 0.0);
  71   n = (-1/FGColumnVector3(l).Magnitude())*FGColumnVector3(l);
  72   double r = l.GetRadius();
  73   double agl = GetAltitude(l);
  74   cont = ((r-agl)/r)*FGColumnVector3(l);
  75   return agl;
  76 }
  77
  78 }