src/FDM/JSBSim/FGMassBalance.cpp

   1 /*%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
   2
   3  Module:       FGMassBalance.cpp
   4  Author:       Jon S. Berndt
   5  Date started: 09/12/2000
   6  Purpose:      This module models weight and balance
   7
   8  ------------- Copyright (C) 2000  Jon S. Berndt (jsb@hal-pc.org) --------------
   9
  10  This program is free software; you can redistribute it and/or modify it under
  11  the terms of the GNU General Public License as published by the Free Software
  12  Foundation; either version 2 of the License, or (at your option) any later
  13  version.
  14
  15  This program is distributed in the hope that it will be useful, but WITHOUT
  16  ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or FITNESS
  17  FOR A PARTICULAR PURPOSE.  See the GNU General Public License for more
  18  details.
  19
  20  You should have received a copy of the GNU General Public License along with
  21  this program; if not, write to the Free Software Foundation, Inc., 59 Temple
  22  Place - Suite 330, Boston, MA  02111-1307, USA.
  23
  24  Further information about the GNU General Public License can also be found on
  25  the world wide web at http://www.gnu.org.
  26
  27 FUNCTIONAL DESCRIPTION
  28 --------------------------------------------------------------------------------
  29
  30 This class models the change in weight and balance of the aircraft due to fuel
  31 burnoff, etc.
  32
  33 HISTORY
  34 --------------------------------------------------------------------------------
  35 09/12/2000  JSB  Created
  36
  37 %%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
  38 INCLUDES
  39 %%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%*/
  40
  41 #include "FGMassBalance.h"
  42
  43 static const char *IdSrc = "$Id$";
  44 static const char *IdHdr = ID_MASSBALANCE;
  45
  46 extern short debug_lvl;
  47
  48 /*%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
  49 CLASS IMPLEMENTATION
  50 %%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%*/
  51
  52
  53 FGMassBalance::FGMassBalance(FGFDMExec* fdmex) : FGModel(fdmex)
  54 {
  55   Name = "FGMassBalance";
  56
  57   if (debug_lvl & 2) cout << "Instantiated: FGMassBalance" << endl;
  58 }
  59
  60 //%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
  61
  62 FGMassBalance::~FGMassBalance()
  63 {
  64   if (debug_lvl & 2) cout << "Destroyed:    FGMassBalance" << endl;
  65 }
  66
  67 //%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
  68
  69 bool FGMassBalance::Run(void)
  70 {
  71   if (!FGModel::Run()) {
  72
  73     Weight = EmptyWeight + Propulsion->GetTanksWeight();
  74
  75     Mass = Weight / GRAVITY;
  76
  77 // Calculate new CG here.
  78
  79     vXYZcg = (Propulsion->GetTanksCG() + EmptyWeight*vbaseXYZcg) / Weight;
  80
  81 // Calculate new moments of inertia here
  82
  83     Ixx = baseIxx + Propulsion->GetTanksIxx(vXYZcg);
  84     Iyy = baseIyy + Propulsion->GetTanksIyy(vXYZcg);
  85     Izz = baseIzz + Propulsion->GetTanksIzz(vXYZcg);
  86     Ixz = baseIxz + Propulsion->GetTanksIxz(vXYZcg);
  87
  88     if (debug_lvl > 1) Debug();
  89
  90     return false;
  91   } else {
  92     return true;
  93   }
  94 }
  95
  96 //%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
  97
  98 void FGMassBalance::Debug(void)
  99 {
 100   if (debug_lvl & 16) { // Sanity check variables
 101     if (EmptyWeight <= 0.0 || EmptyWeight > 1e9)
 102       cout << "MassBalance::EmptyWeight out of bounds: " << EmptyWeight << endl;
 103     if (Weight <= 0.0 || Weight > 1e9)
 104       cout << "MassBalance::Weight out of bounds: " << Weight << endl;
 105     if (Mass <= 0.0 || Mass > 1e9)
 106       cout << "MassBalance::Mass out of bounds: " << Mass << endl;
 107   }
 108 }
 109