-/*******************************************************************************
-
- Module: FGOutput.cpp
- Author: Jon Berndt
- Date started: 12/02/98
- Purpose: Manage output of sim parameters to file or stdout
- Called by: FGSimExec
-
- ------------- Copyright (C) 1999 Jon S. Berndt (jsb@hal-pc.org) -------------
-
- This program is free software; you can redistribute it and/or modify it under
- the terms of the GNU General Public License as published by the Free Software
- Foundation; either version 2 of the License, or (at your option) any later
- version.
-
- This program is distributed in the hope that it will be useful, but WITHOUT
- ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or FITNESS
- FOR A PARTICULAR PURPOSE. See the GNU General Public License for more
- details.
-
- You should have received a copy of the GNU General Public License along with
- this program; if not, write to the Free Software Foundation, Inc., 59 Temple
- Place - Suite 330, Boston, MA 02111-1307, USA.
-
- Further information about the GNU General Public License can also be found on
- the world wide web at http://www.gnu.org.
-
-FUNCTIONAL DESCRIPTION
---------------------------------------------------------------------------------
-This is the place where you create output routines to dump data for perusal
-later. Some machines may not support the ncurses console output. Borland is one
-of those environments which does not, so the ncurses stuff is commented out.
-
-HISTORY
---------------------------------------------------------------------------------
-12/02/98 JSB Created
-
-********************************************************************************
-INCLUDES
-*******************************************************************************/
-
-#include "FGOutput.h"
-#include "FGState.h"
-#include "FGFDMExec.h"
-#include "FGAtmosphere.h"
-#include "FGFCS.h"
-#include "FGAircraft.h"
-#include "FGTranslation.h"
-#include "FGRotation.h"
-#include "FGPosition.h"
-#include "FGAuxiliary.h"
-
-/*******************************************************************************
-************************************ CODE **************************************
-*******************************************************************************/
-
-FGOutput::FGOutput(FGFDMExec* fdmex) : FGModel(fdmex)
-{
- Name = "FGOutput";
- FirstPass = true;
-}
-
-
-FGOutput::~FGOutput(void)
-{
-}
-
-
-bool FGOutput::Run(void)
-{
- if (!FGModel::Run()) {
- DelimitedOutput("JSBSimData.csv");
- } else {
- }
- return false;
-}
-
-
-void FGOutput::DelimitedOutput(void)
-{
- if (FirstPass) {
- cout << "Time,";
- cout << "Altitude,";
- cout << "Phi,";
- cout << "Tht,";
- cout << "Psi,";
- cout << "Rho,";
- cout << "Vtotal,";
- cout << "U,";
- cout << "V,";
- cout << "W,";
- cout << "Vn,";
- cout << "Ve,";
- cout << "Vd,";
- cout << "Udot,";
- cout << "Vdot,";
- cout << "Wdot,";
- cout << "P,";
- cout << "Q,";
- cout << "R,";
- cout << "PDot,";
- cout << "QDot,";
- cout << "RDot,";
- cout << "Fx,";
- cout << "Fy,";
- cout << "Fz,";
- cout << "Latitude,";
- cout << "Longitude,";
- cout << "QBar,";
- cout << "Alpha,";
- cout << "L,";
- cout << "M,";
- cout << "N";
- cout << endl;
- FirstPass = false;
- }
-
- cout << State->Getsim_time() << ",";
- cout << State->Geth() << ",";
- cout << Rotation->Getphi() << ",";
- cout << Rotation->Gettht() << ",";
- cout << Rotation->Getpsi() << ",";
- cout << Atmosphere->GetDensity() << ",";
- cout << State->GetVt() << ",";
- cout << Translation->GetU() << ",";
- cout << Translation->GetV() << ",";
- cout << Translation->GetW() << ",";
- cout << Position->GetVn() << ",";
- cout << Position->GetVe() << ",";
- cout << Position->GetVd() << ",";
- cout << Translation->GetUdot() << ",";
- cout << Translation->GetVdot() << ",";
- cout << Translation->GetWdot() << ",";
- cout << Rotation->GetP() << ",";
- cout << Rotation->GetQ() << ",";
- cout << Rotation->GetR() << ",";
- cout << Rotation->GetPdot() << ",";
- cout << Rotation->GetQdot() << ",";
- cout << Rotation->GetRdot() << ",";
- cout << Aircraft->GetFx() << ",";
- cout << Aircraft->GetFy() << ",";
- cout << Aircraft->GetFz() << ",";
- cout << State->Getlatitude() << ",";
- cout << State->Getlongitude() << ",";
- cout << State->Getqbar() << ",";
- cout << Translation->Getalpha() << ",";
- cout << Aircraft->GetL() << ",";
- cout << Aircraft->GetM() << ",";
- cout << Aircraft->GetN() << "";
- cout << endl;
-
-}
-
-
-void FGOutput::DelimitedOutput(string fname)
-{
- if (FirstPass) {
- datafile.open(fname.c_str());
- datafile << "Time,";
- datafile << "Altitude,";
- datafile << "Phi,";
- datafile << "Tht,";
- datafile << "Psi,";
- datafile << "Rho,";
- datafile << "Vtotal,";
- datafile << "U,";
- datafile << "V,";
- datafile << "W,";
- datafile << "Vn,";
- datafile << "Ve,";
- datafile << "Vd,";
- datafile << "Udot,";
- datafile << "Vdot,";
- datafile << "Wdot,";
- datafile << "P,";
- datafile << "Q,";
- datafile << "R,";
- datafile << "PDot,";
- datafile << "QDot,";
- datafile << "RDot,";
- datafile << "Fx,";
- datafile << "Fy,";
- datafile << "Fz,";
- datafile << "Latitude,";
- datafile << "Longitude,";
- datafile << "QBar,";
- datafile << "Alpha,";
- datafile << "L,";
- datafile << "M,";
- datafile << "N";
- datafile << endl;
- FirstPass = false;
- }
-
- datafile << State->Getsim_time() << ",";
- datafile << State->Geth() << ",";
- datafile << Rotation->Getphi() << ",";
- datafile << Rotation->Gettht() << ",";
- datafile << Rotation->Getpsi() << ",";
- datafile << Atmosphere->GetDensity() << ",";
- datafile << State->GetVt() << ",";
- datafile << Translation->GetU() << ",";
- datafile << Translation->GetV() << ",";
- datafile << Translation->GetW() << ",";
- datafile << Position->GetVn() << ",";
- datafile << Position->GetVe() << ",";
- datafile << Position->GetVd() << ",";
- datafile << Translation->GetUdot() << ",";
- datafile << Translation->GetVdot() << ",";
- datafile << Translation->GetWdot() << ",";
- datafile << Rotation->GetP() << ",";
- datafile << Rotation->GetQ() << ",";
- datafile << Rotation->GetR() << ",";
- datafile << Rotation->GetPdot() << ",";
- datafile << Rotation->GetQdot() << ",";
- datafile << Rotation->GetRdot() << ",";
- datafile << Aircraft->GetFx() << ",";
- datafile << Aircraft->GetFy() << ",";
- datafile << Aircraft->GetFz() << ",";
- datafile << State->Getlatitude() << ",";
- datafile << State->Getlongitude() << ",";
- datafile << State->Getqbar() << ",";
- datafile << Translation->Getalpha() << ",";
- datafile << Aircraft->GetL() << ",";
- datafile << Aircraft->GetM() << ",";
- datafile << Aircraft->GetN() << "";
- datafile << endl;
- datafile.flush();
-}
-
+/*%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%\r
+\r
+ Module: FGOutput.cpp\r
+ Author: Jon Berndt\r
+ Date started: 12/02/98\r
+ Purpose: Manage output of sim parameters to file or stdout\r
+ Called by: FGSimExec\r
+\r
+ ------------- Copyright (C) 1999 Jon S. Berndt (jsb@hal-pc.org) -------------\r
+\r
+ This program is free software; you can redistribute it and/or modify it under\r
+ the terms of the GNU General Public License as published by the Free Software\r
+ Foundation; either version 2 of the License, or (at your option) any later\r
+ version.\r
+\r
+ This program is distributed in the hope that it will be useful, but WITHOUT\r
+ ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or FITNESS\r
+ FOR A PARTICULAR PURPOSE. See the GNU General Public License for more\r
+ details.\r
+\r
+ You should have received a copy of the GNU General Public License along with\r
+ this program; if not, write to the Free Software Foundation, Inc., 59 Temple\r
+ Place - Suite 330, Boston, MA 02111-1307, USA.\r
+\r
+ Further information about the GNU General Public License can also be found on\r
+ the world wide web at http://www.gnu.org.\r
+\r
+FUNCTIONAL DESCRIPTION\r
+--------------------------------------------------------------------------------\r
+This is the place where you create output routines to dump data for perusal\r
+later.\r
+\r
+HISTORY\r
+--------------------------------------------------------------------------------\r
+12/02/98 JSB Created\r
+\r
+%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%\r
+INCLUDES\r
+%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%*/\r
+\r
+#include "FGOutput.h"\r
+#include "FGState.h"\r
+#include "FGFDMExec.h"\r
+#include "FGAtmosphere.h"\r
+#include "FGFCS.h"\r
+#include "FGAerodynamics.h"\r
+#include "FGGroundReactions.h"\r
+#include "FGAircraft.h"\r
+#include "FGMassBalance.h"\r
+#include "FGTranslation.h"\r
+#include "FGRotation.h"\r
+#include "FGPosition.h"\r
+#include "FGAuxiliary.h"\r
+#include "FGInertial.h"\r
+\r
+namespace JSBSim {\r
+\r
+static const char *IdSrc = "$Id$";\r
+static const char *IdHdr = ID_OUTPUT;\r
+\r
+/*%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%\r
+CLASS IMPLEMENTATION\r
+%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%*/\r
+\r
+FGOutput::FGOutput(FGFDMExec* fdmex) : FGModel(fdmex)\r
+{\r
+ Name = "FGOutput";\r
+ sFirstPass = dFirstPass = true;\r
+ socket = 0;\r
+ Type = otNone;\r
+ Filename = "";\r
+ SubSystems = 0;\r
+ enabled = true;\r
+ outputInFileName = "";\r
+\r
+ Debug(0);\r
+}\r
+\r
+//%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%\r
+\r
+FGOutput::~FGOutput()\r
+{\r
+ if (socket) delete socket;\r
+ for (unsigned int i=0; i<OutputProperties.size(); i++) delete OutputProperties[i];\r
+\r
+ Debug(1);\r
+}\r
+\r
+//%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%\r
+\r
+bool FGOutput::Run(void)\r
+{\r
+ if (enabled) {\r
+ if (!FGModel::Run()) {\r
+\r
+ if (Type == otSocket) {\r
+ SocketOutput();\r
+ } else if (Type == otCSV) {\r
+ DelimitedOutput(Filename);\r
+ } else if (Type == otTerminal) {\r
+ // Not done yet\r
+ } else if (Type == otNone) {\r
+ // Do nothing\r
+ } else {\r
+ // Not a valid type of output\r
+ }\r
+ return false;\r
+ } else {\r
+ return true;\r
+ }\r
+ }\r
+ return false;\r
+}\r
+\r
+//%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%\r
+\r
+void FGOutput::SetType(string type)\r
+{\r
+ if (type == "CSV") {\r
+ Type = otCSV;\r
+ } else if (type == "TABULAR") {\r
+ Type = otTab;\r
+ } else if (type == "SOCKET") {\r
+ Type = otSocket;\r
+ } else if (type == "TERMINAL") {\r
+ Type = otTerminal;\r
+ } else if (type != string("NONE")) {\r
+ Type = otUnknown;\r
+ cerr << "Unknown type of output specified in config file" << endl;\r
+ }\r
+}\r
+\r
+//%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%\r
+\r
+void FGOutput::DelimitedOutput(string fname)\r
+{\r
+ streambuf* buffer;\r
+ string scratch = "";\r
+\r
+ if (fname == "COUT" || fname == "cout") {\r
+ buffer = cout.rdbuf();\r
+ } else {\r
+ datafile.open(fname.c_str());\r
+ buffer = datafile.rdbuf();\r
+ }\r
+\r
+ ostream outstream(buffer);\r
+\r
+ if (dFirstPass) {\r
+ outstream << "Time";\r
+ if (SubSystems & ssSimulation) {\r
+ // Nothing here, yet\r
+ }\r
+ if (SubSystems & ssAerosurfaces) {\r
+ outstream << ", ";\r
+ outstream << "Aileron Cmd, ";\r
+ outstream << "Elevator Cmd, ";\r
+ outstream << "Rudder Cmd, ";\r
+ outstream << "Flap Cmd, ";\r
+ outstream << "Left Aileron Pos, ";\r
+ outstream << "Right Aileron Pos, ";\r
+ outstream << "Elevator Pos, ";\r
+ outstream << "Rudder Pos, ";\r
+ outstream << "Flap Pos";\r
+ }\r
+ if (SubSystems & ssRates) {\r
+ outstream << ", ";\r
+ outstream << "P, Q, R, ";\r
+ outstream << "Pdot, Qdot, Rdot";\r
+ }\r
+ if (SubSystems & ssVelocities) {\r
+ outstream << ", ";\r
+ outstream << "QBar, ";\r
+ outstream << "Vtotal, ";\r
+ outstream << "UBody, VBody, WBody, ";\r
+ outstream << "UAero, VAero, WAero, ";\r
+ outstream << "Vn, Ve, Vd";\r
+ }\r
+ if (SubSystems & ssForces) {\r
+ outstream << ", ";\r
+ outstream << "Drag, Side, Lift, ";\r
+ outstream << "L/D, ";\r
+ outstream << "Xforce, Yforce, Zforce, ";\r
+ outstream << "xGravity, yGravity, zGravity, ";\r
+ outstream << "xCoriolis, yCoriolis, zCoriolis, ";\r
+ outstream << "xCentrifugal, yCentrifugal, zCentrifugal";\r
+ }\r
+ if (SubSystems & ssMoments) {\r
+ outstream << ", ";\r
+ outstream << "L, M, N";\r
+ }\r
+ if (SubSystems & ssAtmosphere) {\r
+ outstream << ", ";\r
+ outstream << "Rho, ";\r
+ outstream << "NWind, EWind, DWind";\r
+ }\r
+ if (SubSystems & ssMassProps) {\r
+ outstream << ", ";\r
+ outstream << "Ixx, ";\r
+ outstream << "Ixy, ";\r
+ outstream << "Ixz, ";\r
+ outstream << "Iyx, ";\r
+ outstream << "Iyy, ";\r
+ outstream << "Iyz, ";\r
+ outstream << "Izx, ";\r
+ outstream << "Izy, ";\r
+ outstream << "Izz, ";\r
+ outstream << "Mass, ";\r
+ outstream << "Xcg, Ycg, Zcg";\r
+ }\r
+ if (SubSystems & ssPosition) {\r
+ outstream << ", ";\r
+ outstream << "Altitude, ";\r
+ outstream << "Phi, Tht, Psi, ";\r
+ outstream << "Alpha, ";\r
+ outstream << "Beta, ";\r
+ outstream << "Latitude, ";\r
+ outstream << "Longitude, ";\r
+ outstream << "Distance AGL, ";\r
+ outstream << "Runway Radius";\r
+ }\r
+ if (SubSystems & ssCoefficients) {\r
+ scratch = Aerodynamics->GetCoefficientStrings();\r
+ if (scratch.length() != 0) outstream << ", " << scratch;\r
+ }\r
+ if (SubSystems & ssFCS) {\r
+ scratch = FCS->GetComponentStrings();\r
+ if (scratch.length() != 0) outstream << ", " << scratch;\r
+ }\r
+ if (SubSystems & ssGroundReactions) {\r
+ outstream << ", ";\r
+ outstream << GroundReactions->GetGroundReactionStrings();\r
+ }\r
+ if (SubSystems & ssPropulsion && Propulsion->GetNumEngines() > 0) {\r
+ outstream << ", ";\r
+ outstream << Propulsion->GetPropulsionStrings();\r
+ }\r
+ if (OutputProperties.size() > 0) {\r
+ for (unsigned int i=0;i<OutputProperties.size();i++) {\r
+ outstream << ", " << OutputProperties[i]->GetName();\r
+ }\r
+ }\r
+\r
+ outstream << endl;\r
+ dFirstPass = false;\r
+ }\r
+\r
+ outstream << State->Getsim_time();\r
+ if (SubSystems & ssSimulation) {\r
+ }\r
+ if (SubSystems & ssAerosurfaces) {\r
+ outstream << ", ";\r
+ outstream << FCS->GetDaCmd() << ", ";\r
+ outstream << FCS->GetDeCmd() << ", ";\r
+ outstream << FCS->GetDrCmd() << ", ";\r
+ outstream << FCS->GetDfCmd() << ", ";\r
+ outstream << FCS->GetDaLPos() << ", ";\r
+ outstream << FCS->GetDaRPos() << ", ";\r
+ outstream << FCS->GetDePos() << ", ";\r
+ outstream << FCS->GetDrPos() << ", ";\r
+ outstream << FCS->GetDfPos();\r
+ }\r
+ if (SubSystems & ssRates) {\r
+ outstream << ", ";\r
+ outstream << Rotation->GetPQR() << ", ";\r
+ outstream << Rotation->GetPQRdot();\r
+ }\r
+ if (SubSystems & ssVelocities) {\r
+ outstream << ", ";\r
+ outstream << Translation->Getqbar() << ", ";\r
+ outstream << Translation->GetVt() << ", ";\r
+ outstream << Translation->GetUVW() << ", ";\r
+ outstream << Translation->GetAeroUVW() << ", ";\r
+ outstream << Position->GetVel();\r
+ }\r
+ if (SubSystems & ssForces) {\r
+ outstream << ", ";\r
+ outstream << Aerodynamics->GetvFs() << ", ";\r
+ outstream << Aerodynamics->GetLoD() << ", ";\r
+ outstream << Aircraft->GetForces() << ", ";\r
+ outstream << Inertial->GetGravity() << ", ";\r
+ outstream << Inertial->GetCoriolis() << ", ";\r
+ outstream << Inertial->GetCentrifugal();\r
+ }\r
+ if (SubSystems & ssMoments) {\r
+ outstream << ", ";\r
+ outstream << Aircraft->GetMoments();\r
+ }\r
+ if (SubSystems & ssAtmosphere) {\r
+ outstream << ", ";\r
+ outstream << Atmosphere->GetDensity() << ", ";\r
+ outstream << Atmosphere->GetWindNED();\r
+ }\r
+ if (SubSystems & ssMassProps) {\r
+ outstream << ", ";\r
+ outstream << MassBalance->GetJ() << ", ";\r
+ outstream << MassBalance->GetMass() << ", ";\r
+ outstream << MassBalance->GetXYZcg();\r
+ }\r
+ if (SubSystems & ssPosition) {\r
+ outstream << ", ";\r
+ outstream << Position->Geth() << ", ";\r
+ outstream << Rotation->GetEuler() << ", ";\r
+ outstream << Translation->Getalpha() << ", ";\r
+ outstream << Translation->Getbeta() << ", ";\r
+ outstream << Position->GetLatitude() << ", ";\r
+ outstream << Position->GetLongitude() << ", ";\r
+ outstream << Position->GetDistanceAGL() << ", ";\r
+ outstream << Position->GetRunwayRadius();\r
+ }\r
+ if (SubSystems & ssCoefficients) {\r
+ scratch = Aerodynamics->GetCoefficientValues();\r
+ if (scratch.length() != 0) outstream << ", " << scratch;\r
+ }\r
+ if (SubSystems & ssFCS) {\r
+ scratch = FCS->GetComponentValues();\r
+ if (scratch.length() != 0) outstream << ", " << scratch;\r
+ }\r
+ if (SubSystems & ssGroundReactions) {\r
+ outstream << ", ";\r
+ outstream << GroundReactions->GetGroundReactionValues();\r
+ }\r
+ if (SubSystems & ssPropulsion && Propulsion->GetNumEngines() > 0) {\r
+ outstream << ", ";\r
+ outstream << Propulsion->GetPropulsionValues();\r
+ }\r
+\r
+ for (unsigned int i=0;i<OutputProperties.size();i++) {\r
+ outstream << ", " << OutputProperties[i]->getDoubleValue();\r
+ }\r
+\r
+ outstream << endl;\r
+ outstream.flush();\r
+}\r
+\r
+//%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%\r
+\r
+void FGOutput::SocketOutput(void)\r
+{\r
+ string asciiData;\r
+\r
+ if (socket == NULL) return;\r
+ if (!socket->GetConnectStatus()) return;\r
+\r
+ socket->Clear();\r
+ if (sFirstPass) {\r
+ socket->Append("<LABELS>");\r
+ socket->Append("Time");\r
+ socket->Append("Altitude");\r
+ socket->Append("Phi");\r
+ socket->Append("Tht");\r
+ socket->Append("Psi");\r
+ socket->Append("Rho");\r
+ socket->Append("Vtotal");\r
+ socket->Append("UBody");\r
+ socket->Append("VBody");\r
+ socket->Append("WBody");\r
+ socket->Append("UAero");\r
+ socket->Append("VAero");\r
+ socket->Append("WAero");\r
+ socket->Append("Vn");\r
+ socket->Append("Ve");\r
+ socket->Append("Vd");\r
+ socket->Append("Udot");\r
+ socket->Append("Vdot");\r
+ socket->Append("Wdot");\r
+ socket->Append("P");\r
+ socket->Append("Q");\r
+ socket->Append("R");\r
+ socket->Append("PDot");\r
+ socket->Append("QDot");\r
+ socket->Append("RDot");\r
+ socket->Append("Fx");\r
+ socket->Append("Fy");\r
+ socket->Append("Fz");\r
+ socket->Append("Latitude");\r
+ socket->Append("Longitude");\r
+ socket->Append("QBar");\r
+ socket->Append("Alpha");\r
+ socket->Append("L");\r
+ socket->Append("M");\r
+ socket->Append("N");\r
+ socket->Append("Throttle Position");\r
+ socket->Append("Left Aileron Position");\r
+ socket->Append("Right Aileron Position");\r
+ socket->Append("Elevator Position");\r
+ socket->Append("Rudder Position");\r
+ sFirstPass = false;\r
+ socket->Send();\r
+ }\r
+\r
+ socket->Clear();\r
+ socket->Append(State->Getsim_time());\r
+ socket->Append(Position->Geth());\r
+ socket->Append(Rotation->Getphi());\r
+ socket->Append(Rotation->Gettht());\r
+ socket->Append(Rotation->Getpsi());\r
+ socket->Append(Atmosphere->GetDensity());\r
+ socket->Append(Translation->GetVt());\r
+ socket->Append(Translation->GetUVW(eU));\r
+ socket->Append(Translation->GetUVW(eV));\r
+ socket->Append(Translation->GetUVW(eW));\r
+ socket->Append(Translation->GetAeroUVW(eU));\r
+ socket->Append(Translation->GetAeroUVW(eV));\r
+ socket->Append(Translation->GetAeroUVW(eW));\r
+ socket->Append(Position->GetVn());\r
+ socket->Append(Position->GetVe());\r
+ socket->Append(Position->GetVd());\r
+ socket->Append(Translation->GetUVWdot(eU));\r
+ socket->Append(Translation->GetUVWdot(eV));\r
+ socket->Append(Translation->GetUVWdot(eW));\r
+ socket->Append(Rotation->GetPQR(eP));\r
+ socket->Append(Rotation->GetPQR(eQ));\r
+ socket->Append(Rotation->GetPQR(eR));\r
+ socket->Append(Rotation->GetPQRdot(eP));\r
+ socket->Append(Rotation->GetPQRdot(eQ));\r
+ socket->Append(Rotation->GetPQRdot(eR));\r
+ socket->Append(Aircraft->GetForces(eX));\r
+ socket->Append(Aircraft->GetForces(eY));\r
+ socket->Append(Aircraft->GetForces(eZ));\r
+ socket->Append(Position->GetLatitude());\r
+ socket->Append(Position->GetLongitude());\r
+ socket->Append(Translation->Getqbar());\r
+ socket->Append(Translation->Getalpha());\r
+ socket->Append(Aircraft->GetMoments(eL));\r
+ socket->Append(Aircraft->GetMoments(eM));\r
+ socket->Append(Aircraft->GetMoments(eN));\r
+ socket->Append(FCS->GetThrottlePos(0));\r
+ socket->Append(FCS->GetDaLPos());\r
+ socket->Append(FCS->GetDaRPos());\r
+ socket->Append(FCS->GetDePos());\r
+ socket->Append(FCS->GetDrPos());\r
+ socket->Send();\r
+}\r
+\r
+//%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%\r
+\r
+void FGOutput::SocketStatusOutput(string out_str)\r
+{\r
+ string asciiData;\r
+\r
+ if (socket == NULL) return;\r
+\r
+ socket->Clear();\r
+ asciiData = string("<STATUS>") + out_str;\r
+ socket->Append(asciiData.c_str());\r
+ socket->Send();\r
+}\r
+\r
+//%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%\r
+\r
+bool FGOutput::Load(FGConfigFile* AC_cfg)\r
+{\r
+ string token="", parameter="", separator="";\r
+ string name="", fname="";\r
+ int OutRate = 0;\r
+ FGConfigFile* Output_cfg;\r
+ string property;\r
+\r
+# ifndef macintosh\r
+ separator = "/";\r
+# else\r
+ separator = ";";\r
+# endif\r
+\r
+ name = AC_cfg->GetValue("NAME");\r
+ fname = AC_cfg->GetValue("FILE");\r
+ token = AC_cfg->GetValue("TYPE");\r
+ Output->SetType(token);\r
+\r
+#if defined( FG_WITH_JSBSIM_SOCKET ) || !defined( FGFS )\r
+ if (token == "SOCKET") {\r
+ socket = new FGfdmSocket("localhost",1138);\r
+ }\r
+#endif\r
+\r
+ if (!fname.empty()) {\r
+ outputInFileName = FDMExec->GetAircraftPath() + separator\r
+ + FDMExec->GetModelName() + separator + fname + ".xml";\r
+ Output_cfg = new FGConfigFile(outputInFileName);\r
+ if (!Output_cfg->IsOpen()) {\r
+ cerr << "Could not open file: " << outputInFileName << endl;\r
+ return false;\r
+ }\r
+ } else {\r
+ Output_cfg = AC_cfg;\r
+ }\r
+ Output->SetFilename(name);\r
+\r
+ while ((token = Output_cfg->GetValue()) != string("/OUTPUT")) {\r
+ *Output_cfg >> parameter;\r
+ if (parameter == "RATE_IN_HZ") {\r
+ *Output_cfg >> OutRate;\r
+ }\r
+ if (parameter == "SIMULATION") {\r
+ *Output_cfg >> parameter;\r
+ if (parameter == "ON") SubSystems += ssSimulation;\r
+ }\r
+ if (parameter == "AEROSURFACES") {\r
+ *Output_cfg >> parameter;\r
+ if (parameter == "ON") SubSystems += ssAerosurfaces;\r
+ }\r
+ if (parameter == "RATES") {\r
+ *Output_cfg >> parameter;\r
+ if (parameter == "ON") SubSystems += ssRates;\r
+ }\r
+ if (parameter == "VELOCITIES") {\r
+ *Output_cfg >> parameter;\r
+ if (parameter == "ON") SubSystems += ssVelocities;\r
+ }\r
+ if (parameter == "FORCES") {\r
+ *Output_cfg >> parameter;\r
+ if (parameter == "ON") SubSystems += ssForces;\r
+ }\r
+ if (parameter == "MOMENTS") {\r
+ *Output_cfg >> parameter;\r
+ if (parameter == "ON") SubSystems += ssMoments;\r
+ }\r
+ if (parameter == "ATMOSPHERE") {\r
+ *Output_cfg >> parameter;\r
+ if (parameter == "ON") SubSystems += ssAtmosphere;\r
+ }\r
+ if (parameter == "MASSPROPS") {\r
+ *Output_cfg >> parameter;\r
+ if (parameter == "ON") SubSystems += ssMassProps;\r
+ }\r
+ if (parameter == "POSITION") {\r
+ *Output_cfg >> parameter;\r
+ if (parameter == "ON") SubSystems += ssPosition;\r
+ }\r
+ if (parameter == "COEFFICIENTS") {\r
+ *Output_cfg >> parameter;\r
+ if (parameter == "ON") SubSystems += ssCoefficients;\r
+ }\r
+ if (parameter == "GROUND_REACTIONS") {\r
+ *Output_cfg >> parameter;\r
+ if (parameter == "ON") SubSystems += ssGroundReactions;\r
+ }\r
+ if (parameter == "FCS") {\r
+ *Output_cfg >> parameter;\r
+ if (parameter == "ON") SubSystems += ssFCS;\r
+ }\r
+ if (parameter == "PROPULSION") {\r
+ *Output_cfg >> parameter;\r
+ if (parameter == "ON") SubSystems += ssPropulsion;\r
+ }\r
+ if (parameter == "PROPERTY") {\r
+ *Output_cfg >> property;\r
+ OutputProperties.push_back(PropertyManager->GetNode(property));\r
+ }\r
+\r
+ if (parameter == "EOF") break;\r
+ }\r
+\r
+ OutRate = OutRate>120?120:(OutRate<0?0:OutRate);\r
+ rate = (int)(0.5 + 1.0/(State->Getdt()*OutRate));\r
+\r
+ Debug(2);\r
+\r
+ return true;\r
+}\r
+\r
+//%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%\r
+// The bitmasked value choices are as follows:\r
+// unset: In this case (the default) JSBSim would only print\r
+// out the normally expected messages, essentially echoing\r
+// the config files as they are read. If the environment\r
+// variable is not set, debug_lvl is set to 1 internally\r
+// 0: This requests JSBSim not to output any messages\r
+// whatsoever.\r
+// 1: This value explicity requests the normal JSBSim\r
+// startup messages\r
+// 2: This value asks for a message to be printed out when\r
+// a class is instantiated\r
+// 4: When this value is set, a message is displayed when a\r
+// FGModel object executes its Run() method\r
+// 8: When this value is set, various runtime state variables\r
+// are printed out periodically\r
+// 16: When set various parameters are sanity checked and\r
+// a message is printed out when they go out of bounds\r
+\r
+void FGOutput::Debug(int from)\r
+{\r
+ string scratch="";\r
+\r
+ if (debug_lvl <= 0) return;\r
+\r
+ if (debug_lvl & 1) { // Standard console startup message output\r
+ if (from == 0) { // Constructor\r
+\r
+ }\r
+ if (from == 2) {\r
+ if (outputInFileName.empty())\r
+ cout << " " << "Output parameters read inline" << endl;\r
+ else\r
+ cout << " Output parameters read from file: " << outputInFileName << endl;\r
+\r
+ if (Filename == "cout" || Filename == "COUT") {\r
+ scratch = " Log output goes to screen console";\r
+ } else if (!Filename.empty()) {\r
+ scratch = " Log output goes to file: " + Filename;\r
+ }\r
+ switch (Type) {\r
+ case otCSV:\r
+ cout << scratch << " in CSV format output at rate " << 120/rate << " Hz" << endl;\r
+ break;\r
+ case otNone:\r
+ cout << " No log output" << endl;\r
+ break;\r
+ }\r
+\r
+ if (SubSystems & ssSimulation) cout << " Simulation parameters logged" << endl;\r
+ if (SubSystems & ssAerosurfaces) cout << " Aerosurface parameters logged" << endl;\r
+ if (SubSystems & ssRates) cout << " Rate parameters logged" << endl;\r
+ if (SubSystems & ssVelocities) cout << " Velocity parameters logged" << endl;\r
+ if (SubSystems & ssForces) cout << " Force parameters logged" << endl;\r
+ if (SubSystems & ssMoments) cout << " Moments parameters logged" << endl;\r
+ if (SubSystems & ssAtmosphere) cout << " Atmosphere parameters logged" << endl;\r
+ if (SubSystems & ssMassProps) cout << " Mass parameters logged" << endl;\r
+ if (SubSystems & ssCoefficients) cout << " Coefficient parameters logged" << endl;\r
+ if (SubSystems & ssPosition) cout << " Position parameters logged" << endl;\r
+ if (SubSystems & ssGroundReactions) cout << " Ground parameters logged" << endl;\r
+ if (SubSystems & ssFCS) cout << " FCS parameters logged" << endl;\r
+ if (SubSystems & ssPropulsion) cout << " Propulsion parameters logged" << endl;\r
+ }\r
+ }\r
+ if (debug_lvl & 2 ) { // Instantiation/Destruction notification\r
+ if (from == 0) cout << "Instantiated: FGOutput" << endl;\r
+ if (from == 1) cout << "Destroyed: FGOutput" << endl;\r
+ }\r
+ if (debug_lvl & 4 ) { // Run() method entry print for FGModel-derived objects\r
+ }\r
+ if (debug_lvl & 8 ) { // Runtime state variables\r
+ }\r
+ if (debug_lvl & 16) { // Sanity checking\r
+ }\r
+ if (debug_lvl & 64) {\r
+ if (from == 0) { // Constructor\r
+ cout << IdSrc << endl;\r
+ cout << IdHdr << endl;\r
+ }\r
+ }\r
+}\r
+}\r
projects / flightgear.git / blobdiff