-/*%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
-
- 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.
-
-HISTORY
---------------------------------------------------------------------------------
-12/02/98 JSB Created
-
-%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
-INCLUDES
-%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%*/
-
-#include "FGOutput.h"
-#include "FGState.h"
-#include "FGFDMExec.h"
-#include "FGAtmosphere.h"
-#include "FGFCS.h"
-#include "FGAerodynamics.h"
-#include "FGGroundReactions.h"
-#include "FGAircraft.h"
-#include "FGMassBalance.h"
-#include "FGTranslation.h"
-#include "FGRotation.h"
-#include "FGPosition.h"
-#include "FGAuxiliary.h"
-
-static const char *IdSrc = "$Id$";
-static const char *IdHdr = ID_OUTPUT;
-
-/*%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
-CLASS IMPLEMENTATION
-%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%*/
-
-FGOutput::FGOutput(FGFDMExec* fdmex) : FGModel(fdmex)
-{
- Name = "FGOutput";
- sFirstPass = dFirstPass = true;
- socket = 0;
- Type = otNone;
- Filename = "JSBSim.out";
- SubSystems = 0;
- enabled = true;
-
- Debug(0);
-}
-
-//%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
-
-FGOutput::~FGOutput()
-{
- if (socket) delete socket;
- Debug(1);
-}
-
-//%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
-
-bool FGOutput::Run(void)
-{
- if (enabled) {
- if (!FGModel::Run()) {
-
- if (Type == otSocket) {
- SocketOutput();
- } else if (Type == otCSV) {
- DelimitedOutput(Filename);
- } else if (Type == otTerminal) {
- // Not done yet
- } else if (Type == otNone) {
- // Do nothing
- } else {
- // Not a valid type of output
- }
-
- } else {
- }
- }
- return false;
-}
-
-//%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
-
-void FGOutput::SetType(string type)
-{
- if (type == "CSV") {
- Type = otCSV;
- } else if (type == "TABULAR") {
- Type = otTab;
- } else if (type == "SOCKET") {
- Type = otSocket;
- } else if (type == "TERMINAL") {
- Type = otTerminal;
- } else if (type != string("NONE")){
- Type = otUnknown;
- cerr << "Unknown type of output specified in config file" << endl;
- }
-}
-
-//%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
-
-void FGOutput::DelimitedOutput(string fname)
-{
- streambuf* buffer;
-
- if (fname == "COUT" || fname == "cout") {
- buffer = cout.rdbuf();
- } else {
- datafile.open(fname.c_str());
- buffer = datafile.rdbuf();
- }
-
- ostream outstream(buffer);
-
- if (dFirstPass) {
- outstream << "Time";
- if (SubSystems & ssSimulation) {
- // Nothing here, yet
- }
- if (SubSystems & ssAerosurfaces) {
- outstream << ", ";
- outstream << "Aileron Cmd, ";
- outstream << "Elevator Cmd, ";
- outstream << "Rudder Cmd, ";
- outstream << "Flap Cmd, ";
- outstream << "Left Aileron Pos, ";
- outstream << "Right Aileron Pos, ";
- outstream << "Elevator Pos, ";
- outstream << "Rudder Pos, ";
- outstream << "Flap Pos";
- }
- if (SubSystems & ssRates) {
- outstream << ", ";
- outstream << "P, Q, R, ";
- outstream << "Pdot, Qdot, Rdot";
- }
- if (SubSystems & ssVelocities) {
- outstream << ", ";
- outstream << "QBar, ";
- outstream << "Vtotal, ";
- outstream << "UBody, VBody, WBody, ";
- outstream << "UAero, VAero, WAero, ";
- outstream << "Vn, Ve, Vd";
- }
- if (SubSystems & ssForces) {
- outstream << ", ";
- outstream << "Drag, Side, Lift, ";
- outstream << "L/D, ";
- outstream << "Xforce, Yforce, Zforce";
- }
- if (SubSystems & ssMoments) {
- outstream << ", ";
- outstream << "L, M, N";
- }
- if (SubSystems & ssAtmosphere) {
- outstream << ", ";
- outstream << "Rho, ";
- outstream << "NWind, EWind, DWind";
- }
- if (SubSystems & ssMassProps) {
- outstream << ", ";
- outstream << "Ixx, ";
- outstream << "Iyy, ";
- outstream << "Izz, ";
- outstream << "Ixz, ";
- outstream << "Mass, ";
- outstream << "Xcg, Ycg, Zcg";
- }
- if (SubSystems & ssPosition) {
- outstream << ", ";
- outstream << "Altitude, ";
- outstream << "Phi, Tht, Psi, ";
- outstream << "Alpha, ";
- outstream << "Beta, ";
- outstream << "Latitude, ";
- outstream << "Longitude, ";
- outstream << "Distance AGL, ";
- outstream << "Runway Radius";
- }
- if (SubSystems & ssCoefficients) {
- outstream << ", ";
- outstream << Aerodynamics->GetCoefficientStrings();
- }
- if (SubSystems & ssGroundReactions) {
- outstream << ", ";
- outstream << GroundReactions->GetGroundReactionStrings();
- }
- if (SubSystems & ssPropulsion && Propulsion->GetNumEngines() > 0) {
- outstream << ", ";
- outstream << Propulsion->GetPropulsionStrings();
- }
-
- outstream << endl;
- dFirstPass = false;
- }
-
- outstream << State->Getsim_time();
- if (SubSystems & ssSimulation) {
- }
- if (SubSystems & ssAerosurfaces) {
- outstream << ", ";
- outstream << FCS->GetDaCmd() << ", ";
- outstream << FCS->GetDeCmd() << ", ";
- outstream << FCS->GetDrCmd() << ", ";
- outstream << FCS->GetDfCmd() << ", ";
- outstream << FCS->GetDaLPos() << ", ";
- outstream << FCS->GetDaRPos() << ", ";
- outstream << FCS->GetDePos() << ", ";
- outstream << FCS->GetDrPos() << ", ";
- outstream << FCS->GetDfPos();
- }
- if (SubSystems & ssRates) {
- outstream << ", ";
- outstream << Rotation->GetPQR() << ", ";
- outstream << Rotation->GetPQRdot();
- }
- if (SubSystems & ssVelocities) {
- outstream << ", ";
- outstream << Translation->Getqbar() << ", ";
- outstream << Translation->GetVt() << ", ";
- outstream << Translation->GetUVW() << ", ";
- outstream << Translation->GetvAeroUVW() << ", ";
- outstream << Position->GetVel();
- }
- if (SubSystems & ssForces) {
- outstream << ", ";
- outstream << Aerodynamics->GetvFs() << ", ";
- outstream << Aerodynamics->GetLoD() << ", ";
- outstream << Aircraft->GetForces();
- }
- if (SubSystems & ssMoments) {
- outstream << ", ";
- outstream << Aircraft->GetMoments();
- }
- if (SubSystems & ssAtmosphere) {
- outstream << ", ";
- outstream << Atmosphere->GetDensity() << ", ";
- outstream << Atmosphere->GetWindNED();
- }
- if (SubSystems & ssMassProps) {
- outstream << ", ";
- outstream << MassBalance->GetIxx() << ", ";
- outstream << MassBalance->GetIyy() << ", ";
- outstream << MassBalance->GetIzz() << ", ";
- outstream << MassBalance->GetIxz() << ", ";
- outstream << MassBalance->GetMass() << ", ";
- outstream << MassBalance->GetXYZcg();
- }
- if (SubSystems & ssPosition) {
- outstream << ", ";
- outstream << Position->Geth() << ", ";
- outstream << Rotation->GetEuler() << ", ";
- outstream << Translation->Getalpha() << ", ";
- outstream << Translation->Getbeta() << ", ";
- outstream << Position->GetLatitude() << ", ";
- outstream << Position->GetLongitude() << ", ";
- outstream << Position->GetDistanceAGL() << ", ";
- outstream << Position->GetRunwayRadius();
- }
- if (SubSystems & ssCoefficients) {
- outstream << ", ";
- outstream << Aerodynamics->GetCoefficientValues();
- }
- if (SubSystems & ssGroundReactions) {
- outstream << ", ";
- outstream << GroundReactions->GetGroundReactionValues();
- }
- if (SubSystems & ssPropulsion && Propulsion->GetNumEngines() > 0) {
- outstream << ", ";
- outstream << Propulsion->GetPropulsionValues();
- }
-
- outstream << endl;
- outstream.flush();
-}
-
-//%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
-
-void FGOutput::SocketOutput(void)
-{
- string asciiData;
-
- if (socket == NULL) return;
- if (!socket->GetConnectStatus()) return;
-
- socket->Clear();
- if (sFirstPass) {
- socket->Append("<LABELS>");
- socket->Append("Time");
- socket->Append("Altitude");
- socket->Append("Phi");
- socket->Append("Tht");
- socket->Append("Psi");
- socket->Append("Rho");
- socket->Append("Vtotal");
- socket->Append("UBody");
- socket->Append("VBody");
- socket->Append("WBody");
- socket->Append("UAero");
- socket->Append("VAero");
- socket->Append("WAero");
- socket->Append("Vn");
- socket->Append("Ve");
- socket->Append("Vd");
- socket->Append("Udot");
- socket->Append("Vdot");
- socket->Append("Wdot");
- socket->Append("P");
- socket->Append("Q");
- socket->Append("R");
- socket->Append("PDot");
- socket->Append("QDot");
- socket->Append("RDot");
- socket->Append("Fx");
- socket->Append("Fy");
- socket->Append("Fz");
- socket->Append("Latitude");
- socket->Append("Longitude");
- socket->Append("QBar");
- socket->Append("Alpha");
- socket->Append("L");
- socket->Append("M");
- socket->Append("N");
- socket->Append("Throttle Position");
- socket->Append("Left Aileron Position");
- socket->Append("Right Aileron Position");
- socket->Append("Elevator Position");
- socket->Append("Rudder Position");
- sFirstPass = false;
- socket->Send();
- }
-
- socket->Clear();
- socket->Append(State->Getsim_time());
- socket->Append(Position->Geth());
- socket->Append(Rotation->Getphi());
- socket->Append(Rotation->Gettht());
- socket->Append(Rotation->Getpsi());
- socket->Append(Atmosphere->GetDensity());
- socket->Append(Translation->GetVt());
- socket->Append(Translation->GetUVW(eU));
- socket->Append(Translation->GetUVW(eV));
- socket->Append(Translation->GetUVW(eW));
- socket->Append(Translation->GetvAeroUVW(eU));
- socket->Append(Translation->GetvAeroUVW(eV));
- socket->Append(Translation->GetvAeroUVW(eW));
- socket->Append(Position->GetVn());
- socket->Append(Position->GetVe());
- socket->Append(Position->GetVd());
- socket->Append(Translation->GetUVWdot(eU));
- socket->Append(Translation->GetUVWdot(eV));
- socket->Append(Translation->GetUVWdot(eW));
- socket->Append(Rotation->GetPQR(eP));
- socket->Append(Rotation->GetPQR(eQ));
- socket->Append(Rotation->GetPQR(eR));
- socket->Append(Rotation->GetPQRdot(eP));
- socket->Append(Rotation->GetPQRdot(eQ));
- socket->Append(Rotation->GetPQRdot(eR));
- socket->Append(Aircraft->GetForces(eX));
- socket->Append(Aircraft->GetForces(eY));
- socket->Append(Aircraft->GetForces(eZ));
- socket->Append(Position->GetLatitude());
- socket->Append(Position->GetLongitude());
- socket->Append(Translation->Getqbar());
- socket->Append(Translation->Getalpha());
- socket->Append(Aircraft->GetMoments(eL));
- socket->Append(Aircraft->GetMoments(eM));
- socket->Append(Aircraft->GetMoments(eN));
- socket->Append(FCS->GetThrottlePos(0));
- socket->Append(FCS->GetDaLPos());
- socket->Append(FCS->GetDaRPos());
- socket->Append(FCS->GetDePos());
- socket->Append(FCS->GetDrPos());
- socket->Send();
-}
-
-//%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
-
-void FGOutput::SocketStatusOutput(string out_str)
-{
- string asciiData;
-
- if (socket == NULL) return;
-
- socket->Clear();
- asciiData = string("<STATUS>") + out_str;
- socket->Append(asciiData.c_str());
- socket->Send();
-}
-
-//%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
-
-bool FGOutput::Load(FGConfigFile* AC_cfg)
-{
- string token, parameter;
- int OutRate = 0;
-
- token = AC_cfg->GetValue("NAME");
- Output->SetFilename(token);
- token = AC_cfg->GetValue("TYPE");
- Output->SetType(token);
-
-#if defined( FG_WITH_JSBSIM_SOCKET ) || !defined( FGFS )
- if (token == "SOCKET") {
- socket = new FGfdmSocket("localhost",1138);
- }
-#endif
-
- AC_cfg->GetNextConfigLine();
-
- while ((token = AC_cfg->GetValue()) != string("/OUTPUT")) {
- *AC_cfg >> parameter;
- if (parameter == "RATE_IN_HZ") *AC_cfg >> OutRate;
- if (parameter == "SIMULATION") {
- *AC_cfg >> parameter;
- if (parameter == "ON") SubSystems += ssSimulation;
- }
- if (parameter == "AEROSURFACES") {
- *AC_cfg >> parameter;
- if (parameter == "ON") SubSystems += ssAerosurfaces;
- }
- if (parameter == "RATES") {
- *AC_cfg >> parameter;
- if (parameter == "ON") SubSystems += ssRates;
- }
- if (parameter == "VELOCITIES") {
- *AC_cfg >> parameter;
- if (parameter == "ON") SubSystems += ssVelocities;
- }
- if (parameter == "FORCES") {
- *AC_cfg >> parameter;
- if (parameter == "ON") SubSystems += ssForces;
- }
- if (parameter == "MOMENTS") {
- *AC_cfg >> parameter;
- if (parameter == "ON") SubSystems += ssMoments;
- }
- if (parameter == "ATMOSPHERE") {
- *AC_cfg >> parameter;
- if (parameter == "ON") SubSystems += ssAtmosphere;
- }
- if (parameter == "MASSPROPS") {
- *AC_cfg >> parameter;
- if (parameter == "ON") SubSystems += ssMassProps;
- }
- if (parameter == "POSITION") {
- *AC_cfg >> parameter;
- if (parameter == "ON") SubSystems += ssPosition;
- }
- if (parameter == "COEFFICIENTS") {
- *AC_cfg >> parameter;
- if (parameter == "ON") SubSystems += ssCoefficients;
- }
- if (parameter == "GROUND_REACTIONS") {
- *AC_cfg >> parameter;
- if (parameter == "ON") SubSystems += ssGroundReactions;
- }
- if (parameter == "FCS") {
- *AC_cfg >> parameter;
- if (parameter == "ON") SubSystems += ssFCS;
- }
- if (parameter == "PROPULSION") {
- *AC_cfg >> parameter;
- if (parameter == "ON") SubSystems += ssPropulsion;
- }
- }
-
- OutRate = OutRate>120?120:(OutRate<0?0:OutRate);
- rate = (int)(0.5 + 1.0/(State->Getdt()*OutRate));
-
- return true;
-}
-
-//%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
-// The bitmasked value choices are as follows:
-// unset: In this case (the default) JSBSim would only print
-// out the normally expected messages, essentially echoing
-// the config files as they are read. If the environment
-// variable is not set, debug_lvl is set to 1 internally
-// 0: This requests JSBSim not to output any messages
-// whatsoever.
-// 1: This value explicity requests the normal JSBSim
-// startup messages
-// 2: This value asks for a message to be printed out when
-// a class is instantiated
-// 4: When this value is set, a message is displayed when a
-// FGModel object executes its Run() method
-// 8: When this value is set, various runtime state variables
-// are printed out periodically
-// 16: When set various parameters are sanity checked and
-// a message is printed out when they go out of bounds
-
-void FGOutput::Debug(int from)
-{
- if (debug_lvl <= 0) return;
-
- if (debug_lvl & 1) { // Standard console startup message output
- if (from == 0) { // Constructor
-
- }
- }
- if (debug_lvl & 2 ) { // Instantiation/Destruction notification
- if (from == 0) cout << "Instantiated: FGOutput" << endl;
- if (from == 1) cout << "Destroyed: FGOutput" << endl;
- }
- if (debug_lvl & 4 ) { // Run() method entry print for FGModel-derived objects
- }
- if (debug_lvl & 8 ) { // Runtime state variables
- }
- if (debug_lvl & 16) { // Sanity checking
- }
- if (debug_lvl & 64) {
- if (from == 0) { // Constructor
- cout << IdSrc << endl;
- cout << IdHdr << endl;
- }
- }
-}
-
+/*%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%\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