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 /*%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
  47 CLASS IMPLEMENTATION
  48 %%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%*/
  49
  50
  51 FGMassBalance::FGMassBalance(FGFDMExec* fdmex) : FGModel(fdmex)
  52 {
  53   Name = "FGMassBalance";
  54
  55   if (debug_lvl & 2) cout << "Instantiated: FGMassBalance" << endl;
  56 }
  57
  58 //%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
  59
  60 FGMassBalance::~FGMassBalance()
  61 {
  62   if (debug_lvl & 2) cout << "Destroyed:    FGMassBalance" << endl;
  63 }
  64
  65 //%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
  66
  67 bool FGMassBalance::Run(void)
  68 {
  69   if (!FGModel::Run()) {
  70
  71     Weight = EmptyWeight + Propulsion->GetTanksWeight();
  72
  73     Mass = Weight / GRAVITY;
  74
  75 // Calculate new CG here.
  76
  77     vXYZcg = (Propulsion->GetTanksCG() + EmptyWeight*vbaseXYZcg) / Weight;
  78
  79 // Calculate new moments of inertia here
  80
  81     Ixx = baseIxx + Propulsion->GetTanksIxx(vXYZcg);
  82     Iyy = baseIyy + Propulsion->GetTanksIyy(vXYZcg);
  83     Izz = baseIzz + Propulsion->GetTanksIzz(vXYZcg);
  84     Ixz = baseIxz + Propulsion->GetTanksIxz(vXYZcg);
  85
  86     if (debug_lvl > 1) Debug();
  87
  88     return false;
  89   } else {
  90     return true;
  91   }
  92 }
  93
  94 //%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
  95
  96 void FGMassBalance::Debug(void)
  97 {
  98   if (debug_lvl & 16) { // Sanity check variables
  99     if (EmptyWeight <= 0.0 || EmptyWeight > 1e9)
 100       cout << "MassBalance::EmptyWeight out of bounds: " << EmptyWeight << endl;
 101     if (Weight <= 0.0 || Weight > 1e9)
 102       cout << "MassBalance::Weight out of bounds: " << Weight << endl;
 103     if (Mass <= 0.0 || Mass > 1e9)
 104       cout << "MassBalance::Mass out of bounds: " << Mass << endl;
 105   }
 106 }
 107