src/FDM/JSBSim/FGOutput.cpp

   1 /*******************************************************************************
   2
   3  Module:       FGOutput.cpp
   4  Author:       Jon Berndt
   5  Date started: 12/02/98
   6  Purpose:      Manage output of sim parameters to file or stdout
   7  Called by:    FGSimExec
   8
   9  ------------- Copyright (C) 1999  Jon S. Berndt (jsb@hal-pc.org) -------------
  10
  11  This program is free software; you can redistribute it and/or modify it under
  12  the terms of the GNU General Public License as published by the Free Software
  13  Foundation; either version 2 of the License, or (at your option) any later
  14  version.
  15
  16  This program is distributed in the hope that it will be useful, but WITHOUT
  17  ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or FITNESS
  18  FOR A PARTICULAR PURPOSE.  See the GNU General Public License for more
  19  details.
  20
  21  You should have received a copy of the GNU General Public License along with
  22  this program; if not, write to the Free Software Foundation, Inc., 59 Temple
  23  Place - Suite 330, Boston, MA  02111-1307, USA.
  24
  25  Further information about the GNU General Public License can also be found on
  26  the world wide web at http://www.gnu.org.
  27
  28 FUNCTIONAL DESCRIPTION
  29 --------------------------------------------------------------------------------
  30 This is the place where you create output routines to dump data for perusal
  31 later. Some machines may not support the ncurses console output. Borland is one
  32 of those environments which does not, so the ncurses stuff is commented out.
  33
  34 HISTORY
  35 --------------------------------------------------------------------------------
  36 12/02/98   JSB   Created
  37
  38 ********************************************************************************
  39 INCLUDES
  40 *******************************************************************************/
  41
  42 #include "FGOutput.h"
  43 #include "FGState.h"
  44 #include "FGFDMExec.h"
  45 #include "FGAtmosphere.h"
  46 #include "FGFCS.h"
  47 #include "FGAircraft.h"
  48 #include "FGTranslation.h"
  49 #include "FGRotation.h"
  50 #include "FGPosition.h"
  51 #include "FGAuxiliary.h"
  52
  53 /*******************************************************************************
  54 ************************************ CODE **************************************
  55 *******************************************************************************/
  56
  57 FGOutput::FGOutput(FGFDMExec* fdmex) : FGModel(fdmex)
  58 {
  59   Name = "FGOutput";
  60   sFirstPass = dFirstPass = true;
  61
  62 #ifdef FG_WITH_JSBSIM_SOCKET
  63   socket = new FGfdmSocket("localhost",1138);
  64 #endif
  65 }
  66
  67
  68 FGOutput::~FGOutput(void)
  69 {
  70   if (socket) delete socket;
  71 }
  72
  73
  74 bool FGOutput::Run(void)
  75 {
  76   if (!FGModel::Run()) {
  77     SocketOutput();
  78 //    DelimitedOutput("JSBSimData.csv");
  79   } else {
  80   }
  81   return false;
  82 }
  83
  84
  85 void FGOutput::DelimitedOutput(void)
  86 {
  87   if (dFirstPass) {
  88     cout << "Time,";
  89     cout << "Altitude,";
  90     cout << "Phi,";
  91     cout << "Tht,";
  92     cout << "Psi,";
  93     cout << "Rho,";
  94     cout << "Vtotal,";
  95     cout << "U,";
  96     cout << "V,";
  97     cout << "W,";
  98     cout << "Vn,";
  99     cout << "Ve,";
 100     cout << "Vd,";
 101     cout << "Udot,";
 102     cout << "Vdot,";
 103     cout << "Wdot,";
 104     cout << "P,";
 105     cout << "Q,";
 106     cout << "R,";
 107     cout << "PDot,";
 108     cout << "QDot,";
 109     cout << "RDot,";
 110     cout << "Fx,";
 111     cout << "Fy,";
 112     cout << "Fz,";
 113     cout << "Latitude,";
 114     cout << "Longitude,";
 115     cout << "QBar,";
 116     cout << "Alpha,";
 117     cout << "L,";
 118     cout << "M,";
 119     cout << "N";
 120     cout << endl;
 121     dFirstPass = false;
 122   }
 123
 124   cout << State->Getsim_time() << ",";
 125   cout << State->Geth() << ",";
 126   cout << Rotation->Getphi() << ",";
 127   cout << Rotation->Gettht() << ",";
 128   cout << Rotation->Getpsi() << ",";
 129   cout << Atmosphere->GetDensity() << ",";
 130   cout << State->GetVt() << ",";
 131   cout << Translation->GetU() << ",";
 132   cout << Translation->GetV() << ",";
 133   cout << Translation->GetW() << ",";
 134   cout << Position->GetVn() << ",";
 135   cout << Position->GetVe() << ",";
 136   cout << Position->GetVd() << ",";
 137   cout << Translation->GetUdot() << ",";
 138   cout << Translation->GetVdot() << ",";
 139   cout << Translation->GetWdot() << ",";
 140   cout << Rotation->GetP() << ",";
 141   cout << Rotation->GetQ() << ",";
 142   cout << Rotation->GetR() << ",";
 143   cout << Rotation->GetPdot() << ",";
 144   cout << Rotation->GetQdot() << ",";
 145   cout << Rotation->GetRdot() << ",";
 146   cout << Aircraft->GetFx() << ",";
 147   cout << Aircraft->GetFy() << ",";
 148   cout << Aircraft->GetFz() << ",";
 149   cout << State->Getlatitude() << ",";
 150   cout << State->Getlongitude() << ",";
 151   cout << State->Getqbar() << ",";
 152   cout << Translation->Getalpha() << ",";
 153   cout << Aircraft->GetL() << ",";
 154   cout << Aircraft->GetM() << ",";
 155   cout << Aircraft->GetN() << "";
 156   cout << endl;
 157
 158 }
 159
 160
 161 void FGOutput::DelimitedOutput(string fname)
 162 {
 163   if (sFirstPass) {
 164     datafile.open(fname.c_str());
 165     datafile << "Time,";
 166     datafile << "Altitude,";
 167     datafile << "Phi,";
 168     datafile << "Tht,";
 169     datafile << "Psi,";
 170     datafile << "Rho,";
 171     datafile << "Vtotal,";
 172     datafile << "U,";
 173     datafile << "V,";
 174     datafile << "W,";
 175     datafile << "Vn,";
 176     datafile << "Ve,";
 177     datafile << "Vd,";
 178     datafile << "Udot,";
 179     datafile << "Vdot,";
 180     datafile << "Wdot,";
 181     datafile << "P,";
 182     datafile << "Q,";
 183     datafile << "R,";
 184     datafile << "PDot,";
 185     datafile << "QDot,";
 186     datafile << "RDot,";
 187     datafile << "Fx,";
 188     datafile << "Fy,";
 189     datafile << "Fz,";
 190     datafile << "Latitude,";
 191     datafile << "Longitude,";
 192     datafile << "QBar,";
 193     datafile << "Alpha,";
 194     datafile << "L,";
 195     datafile << "M,";
 196     datafile << "N";
 197     datafile << endl;
 198     sFirstPass = false;
 199   }
 200
 201   datafile << State->Getsim_time() << ",";
 202   datafile << State->Geth() << ",";
 203   datafile << Rotation->Getphi() << ",";
 204   datafile << Rotation->Gettht() << ",";
 205   datafile << Rotation->Getpsi() << ",";
 206   datafile << Atmosphere->GetDensity() << ",";
 207   datafile << State->GetVt() << ",";
 208   datafile << Translation->GetU() << ",";
 209   datafile << Translation->GetV() << ",";
 210   datafile << Translation->GetW() << ",";
 211   datafile << Position->GetVn() << ",";
 212   datafile << Position->GetVe() << ",";
 213   datafile << Position->GetVd() << ",";
 214   datafile << Translation->GetUdot() << ",";
 215   datafile << Translation->GetVdot() << ",";
 216   datafile << Translation->GetWdot() << ",";
 217   datafile << Rotation->GetP() << ",";
 218   datafile << Rotation->GetQ() << ",";
 219   datafile << Rotation->GetR() << ",";
 220   datafile << Rotation->GetPdot() << ",";
 221   datafile << Rotation->GetQdot() << ",";
 222   datafile << Rotation->GetRdot() << ",";
 223   datafile << Aircraft->GetFx() << ",";
 224   datafile << Aircraft->GetFy() << ",";
 225   datafile << Aircraft->GetFz() << ",";
 226   datafile << State->Getlatitude() << ",";
 227   datafile << State->Getlongitude() << ",";
 228   datafile << State->Getqbar() << ",";
 229   datafile << Translation->Getalpha() << ",";
 230   datafile << Aircraft->GetL() << ",";
 231   datafile << Aircraft->GetM() << ",";
 232   datafile << Aircraft->GetN() << "";
 233   datafile << endl;
 234   datafile.flush();
 235 }
 236
 237 void FGOutput::SocketOutput(void)
 238 {
 239   string asciiData;
 240
 241   if (socket <= 0) return;
 242
 243   socket->Clear();
 244   if (sFirstPass) {
 245     socket->Append("<LABELS>");
 246     socket->Append("Time");
 247     socket->Append("Altitude");
 248     socket->Append("Phi");
 249     socket->Append("Tht");
 250     socket->Append("Psi");
 251     socket->Append("Rho");
 252     socket->Append("Vtotal");
 253     socket->Append("U");
 254     socket->Append("V");
 255     socket->Append("W");
 256     socket->Append("Vn");
 257     socket->Append("Ve");
 258     socket->Append("Vd");
 259     socket->Append("Udot");
 260     socket->Append("Vdot");
 261     socket->Append("Wdot");
 262     socket->Append("P");
 263     socket->Append("Q");
 264     socket->Append("R");
 265     socket->Append("PDot");
 266     socket->Append("QDot");
 267     socket->Append("RDot");
 268     socket->Append("Fx");
 269     socket->Append("Fy");
 270     socket->Append("Fz");
 271     socket->Append("Latitude");
 272     socket->Append("Longitude");
 273     socket->Append("QBar");
 274     socket->Append("Alpha");
 275     socket->Append("L");
 276     socket->Append("M");
 277     socket->Append("N");
 278     sFirstPass = false;
 279     socket->Send();
 280   }
 281
 282   socket->Clear();
 283   socket->Append(State->Getsim_time());
 284   socket->Append(State->Geth());
 285   socket->Append(Rotation->Getphi());
 286   socket->Append(Rotation->Gettht());
 287   socket->Append(Rotation->Getpsi());
 288   socket->Append(Atmosphere->GetDensity());
 289   socket->Append(State->GetVt());
 290   socket->Append(Translation->GetU());
 291   socket->Append(Translation->GetV());
 292   socket->Append(Translation->GetW());
 293   socket->Append(Position->GetVn());
 294   socket->Append(Position->GetVe());
 295   socket->Append(Position->GetVd());
 296   socket->Append(Translation->GetUdot());
 297   socket->Append(Translation->GetVdot());
 298   socket->Append(Translation->GetWdot());
 299   socket->Append(Rotation->GetP());
 300   socket->Append(Rotation->GetQ());
 301   socket->Append(Rotation->GetR());
 302   socket->Append(Rotation->GetPdot());
 303   socket->Append(Rotation->GetQdot());
 304   socket->Append(Rotation->GetRdot());
 305   socket->Append(Aircraft->GetFx());
 306   socket->Append(Aircraft->GetFy());
 307   socket->Append(Aircraft->GetFz());
 308   socket->Append(State->Getlatitude());
 309   socket->Append(State->Getlongitude());
 310   socket->Append(State->Getqbar());
 311   socket->Append(Translation->Getalpha());
 312   socket->Append(Aircraft->GetL());
 313   socket->Append(Aircraft->GetM());
 314   socket->Append(Aircraft->GetN());
 315   socket->Send();
 316 }
 317
 318
 319 void FGOutput::SocketStatusOutput(string out_str)
 320 {
 321   string asciiData;
 322
 323   if (socket <= 0) return;
 324
 325   socket->Clear();
 326   asciiData = string("<STATUS>") + out_str;
 327   socket->Append(asciiData.c_str());
 328   socket->Send();
 329 }
 330