1998-09-29 14:56:30 +00:00
|
|
|
// flight.c -- a general interface to the various flight models
|
|
|
|
//
|
|
|
|
// Written by Curtis Olson, started May 1997.
|
|
|
|
//
|
|
|
|
// Copyright (C) 1997 Curtis L. Olson - curt@infoplane.com
|
|
|
|
//
|
|
|
|
// 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., 675 Mass Ave, Cambridge, MA 02139, USA.
|
|
|
|
//
|
|
|
|
// $Id$
|
|
|
|
|
1997-05-29 02:35:04 +00:00
|
|
|
|
1997-05-29 22:39:49 +00:00
|
|
|
#include <stdio.h>
|
1998-04-18 04:13:51 +00:00
|
|
|
|
2000-02-15 03:30:01 +00:00
|
|
|
#include <simgear/constants.h>
|
2000-02-16 23:01:03 +00:00
|
|
|
#include <simgear/debug/logstream.hxx>
|
2000-09-27 20:16:22 +00:00
|
|
|
#include <simgear/math/sg_geodesy.hxx>
|
2000-02-15 03:30:01 +00:00
|
|
|
|
2000-10-28 16:30:30 +00:00
|
|
|
#include <Scenery/scenery.hxx>
|
1999-02-01 21:33:23 +00:00
|
|
|
#include <FDM/LaRCsim/ls_interface.h>
|
2000-10-19 23:09:33 +00:00
|
|
|
#include <Main/globals.hxx>
|
1999-01-19 17:52:06 +00:00
|
|
|
#include <Time/timestamp.hxx>
|
1997-05-29 02:35:04 +00:00
|
|
|
|
1999-11-19 02:12:46 +00:00
|
|
|
#include "External.hxx"
|
1999-02-26 22:09:10 +00:00
|
|
|
#include "flight.hxx"
|
2000-07-24 17:26:05 +00:00
|
|
|
#include "JSBSim.hxx"
|
1999-02-26 22:09:10 +00:00
|
|
|
#include "LaRCsim.hxx"
|
1999-10-12 03:27:06 +00:00
|
|
|
#include "Balloon.h"
|
1999-02-26 22:09:10 +00:00
|
|
|
|
1998-02-07 15:29:31 +00:00
|
|
|
|
1999-01-08 03:23:51 +00:00
|
|
|
// base_fdm_state is the internal state that is updated in integer
|
|
|
|
// multiples of "dt". This leads to "jitter" with respect to the real
|
|
|
|
// world time, so we introduce cur_fdm_state which is extrapolated by
|
|
|
|
// the difference between sim time and real world time
|
|
|
|
|
1999-11-24 14:15:00 +00:00
|
|
|
FGInterface *cur_fdm_state;
|
1999-02-05 21:28:09 +00:00
|
|
|
FGInterface base_fdm_state;
|
1998-02-07 15:29:31 +00:00
|
|
|
|
I tested:
LaRCsim c172 on-ground and in-air starts, reset: all work
UIUC Cessna172 on-ground and in-air starts work as expected, reset
results in an aircraft that is upside down but does not crash FG. I
don't know what it was like before, so it may well be no change.
JSBSim c172 and X15 in-air starts work fine, resets now work (and are
trimmed), on-ground starts do not -- the c172 ends up on its back. I
suspect this is no worse than before.
I did not test:
Balloon (the weather code returns nan's for the atmosphere data --this
is in the weather module and apparently is a linux only bug)
ADA (don't know how)
MagicCarpet (needs work yet)
External (don't know how)
known to be broken:
LaRCsim c172 on-ground starts with a negative terrain altitude (this
happens at KPAO when the scenery is not present). The FDM inits to
about 50 feet AGL and the model falls to the ground. It does stay
upright, however, and seems to be fine once it settles out, FWIW.
To do:
--implement set_Model on the bus
--bring Christian's weather data into JSBSim
-- add default method to bus for updating things like the sin and cos of
latitude (for Balloon, MagicCarpet)
-- lots of cleanup
The files:
src/FDM/flight.cxx
src/FDM/flight.hxx
-- all data members now declared protected instead of private.
-- eliminated all but a small set of 'setters', no change to getters.
-- that small set is declared virtual, the default implementation
provided preserves the old behavior
-- all of the vector data members are now initialized.
-- added busdump() method -- FG_LOG's all the bus data when called,
useful for diagnostics.
src/FDM/ADA.cxx
-- bus data members now directly assigned to
src/FDM/Balloon.cxx
-- bus data members now directly assigned to
-- changed V_equiv_kts to V_calibrated_kts
src/FDM/JSBSim.cxx
src/FDM/JSBSim.hxx
-- bus data members now directly assigned to
-- implemented the FGInterface virtual setters with JSBSim specific
logic
-- changed the static FDMExec to a dynamic fdmex (needed so that the
JSBSim object can be deleted when a model change is called for)
-- implemented constructor and destructor, moved some of the logic
formerly in init() to constructor
-- added logic to bring up FGEngInterface objects and set the RPM and
throttle values.
src/FDM/LaRCsim.cxx
src/FDM/LaRCsim.hxx
-- bus data members now directly assigned to
-- implemented the FGInterface virtual setters with LaRCsim specific
logic, uses LaRCsimIC
-- implemented constructor and destructor, moved some of the logic
formerly in init() to constructor
-- moved default inertias to here from fg_init.cxx
-- eliminated the climb rate calculation. The equivalent, climb_rate =
-1*vdown, is now in copy_from_LaRCsim().
src/FDM/LaRCsimIC.cxx
src/FDM/LaRCsimIC.hxx
-- similar to FGInitialCondition, this class has all the logic needed to
turn data like Vc and Mach into the more fundamental quantities LaRCsim
needs to initialize.
-- put it in src/FDM since it is a class
src/FDM/MagicCarpet.cxx
-- bus data members now directly assigned to
src/FDM/Makefile.am
-- adds LaRCsimIC.hxx and cxx
src/FDM/JSBSim/FGAtmosphere.h
src/FDM/JSBSim/FGDefs.h
src/FDM/JSBSim/FGInitialCondition.cpp
src/FDM/JSBSim/FGInitialCondition.h
src/FDM/JSBSim/JSBSim.cpp
-- changes to accomodate the new bus
src/FDM/LaRCsim/atmos_62.h
src/FDM/LaRCsim/ls_geodesy.h
-- surrounded prototypes with #ifdef __cplusplus ... #endif , functions
here are needed in LaRCsimIC
src/FDM/LaRCsim/c172_main.c
src/FDM/LaRCsim/cherokee_aero.c
src/FDM/LaRCsim/ls_aux.c
src/FDM/LaRCsim/ls_constants.h
src/FDM/LaRCsim/ls_geodesy.c
src/FDM/LaRCsim/ls_geodesy.h
src/FDM/LaRCsim/ls_step.c
src/FDM/UIUCModel/uiuc_betaprobe.cpp
-- changed PI to LS_PI, eliminates preprocessor naming conflict with
weather module
src/FDM/LaRCsim/ls_interface.c
src/FDM/LaRCsim/ls_interface.h
-- added function ls_set_model_dt()
src/Main/bfi.cxx
-- eliminated calls that set the NED speeds to body components. They
are no longer needed and confuse the new bus.
src/Main/fg_init.cxx
-- eliminated calls that just brought the bus data up-to-date (e.g.
set_sin_cos_latitude). or set default values. The bus now handles the
defaults and updates itself when the setters are called (for LaRCsim and
JSBSim). A default method for doing this needs to be added to the bus.
-- added fgVelocityInit() to set the speed the user asked for. Both
JSBSim and LaRCsim can now be initialized using any of:
vc,mach, NED components, UVW components.
src/Main/main.cxx
--eliminated call to fgFDMSetGroundElevation, this data is now 'pulled'
onto the bus every update()
src/Main/options.cxx
src/Main/options.hxx
-- added enum to keep track of the speed requested by the user
-- eliminated calls to set NED velocity properties to body speeds, they
are no longer needed.
-- added options for the NED components.
src/Network/garmin.cxx
src/Network/nmea.cxx
--eliminated calls that just brought the bus data up-to-date (e.g.
set_sin_cos_latitude). The bus now updates itself when the setters are
called (for LaRCsim and JSBSim). A default method for doing this needs
to be added to the bus.
-- changed set_V_equiv_kts to set_V_calibrated_kts. set_V_equiv_kts no
longer exists ( get_V_equiv_kts still does, though)
src/WeatherCM/FGLocalWeatherDatabase.cpp
-- commented out the code to put the weather data on the bus, a
different scheme for this is needed.
2000-10-24 00:34:50 +00:00
|
|
|
inline void init_vec(FG_VECTOR_3 vec) {
|
|
|
|
vec[0] = 0.0; vec[1] = 0.0; vec[2] = 0.0;
|
|
|
|
}
|
|
|
|
|
|
|
|
FGEngInterface::FGEngInterface(void) {
|
|
|
|
|
|
|
|
// inputs
|
|
|
|
Throttle=0;
|
|
|
|
Mixture=0;
|
|
|
|
Prop_Advance=0;
|
|
|
|
|
|
|
|
// outputs
|
|
|
|
RPM=0;
|
|
|
|
Manifold_Pressure=0;
|
|
|
|
MaxHP=0;
|
|
|
|
Percentage_Power=0;
|
|
|
|
EGT=0;
|
|
|
|
prop_thrust=0;
|
|
|
|
}
|
|
|
|
|
|
|
|
FGEngInterface::~FGEngInterface(void) {
|
|
|
|
}
|
|
|
|
|
1998-02-07 15:29:31 +00:00
|
|
|
|
2000-08-14 20:12:17 +00:00
|
|
|
// Constructor
|
|
|
|
FGInterface::FGInterface(void) {
|
I tested:
LaRCsim c172 on-ground and in-air starts, reset: all work
UIUC Cessna172 on-ground and in-air starts work as expected, reset
results in an aircraft that is upside down but does not crash FG. I
don't know what it was like before, so it may well be no change.
JSBSim c172 and X15 in-air starts work fine, resets now work (and are
trimmed), on-ground starts do not -- the c172 ends up on its back. I
suspect this is no worse than before.
I did not test:
Balloon (the weather code returns nan's for the atmosphere data --this
is in the weather module and apparently is a linux only bug)
ADA (don't know how)
MagicCarpet (needs work yet)
External (don't know how)
known to be broken:
LaRCsim c172 on-ground starts with a negative terrain altitude (this
happens at KPAO when the scenery is not present). The FDM inits to
about 50 feet AGL and the model falls to the ground. It does stay
upright, however, and seems to be fine once it settles out, FWIW.
To do:
--implement set_Model on the bus
--bring Christian's weather data into JSBSim
-- add default method to bus for updating things like the sin and cos of
latitude (for Balloon, MagicCarpet)
-- lots of cleanup
The files:
src/FDM/flight.cxx
src/FDM/flight.hxx
-- all data members now declared protected instead of private.
-- eliminated all but a small set of 'setters', no change to getters.
-- that small set is declared virtual, the default implementation
provided preserves the old behavior
-- all of the vector data members are now initialized.
-- added busdump() method -- FG_LOG's all the bus data when called,
useful for diagnostics.
src/FDM/ADA.cxx
-- bus data members now directly assigned to
src/FDM/Balloon.cxx
-- bus data members now directly assigned to
-- changed V_equiv_kts to V_calibrated_kts
src/FDM/JSBSim.cxx
src/FDM/JSBSim.hxx
-- bus data members now directly assigned to
-- implemented the FGInterface virtual setters with JSBSim specific
logic
-- changed the static FDMExec to a dynamic fdmex (needed so that the
JSBSim object can be deleted when a model change is called for)
-- implemented constructor and destructor, moved some of the logic
formerly in init() to constructor
-- added logic to bring up FGEngInterface objects and set the RPM and
throttle values.
src/FDM/LaRCsim.cxx
src/FDM/LaRCsim.hxx
-- bus data members now directly assigned to
-- implemented the FGInterface virtual setters with LaRCsim specific
logic, uses LaRCsimIC
-- implemented constructor and destructor, moved some of the logic
formerly in init() to constructor
-- moved default inertias to here from fg_init.cxx
-- eliminated the climb rate calculation. The equivalent, climb_rate =
-1*vdown, is now in copy_from_LaRCsim().
src/FDM/LaRCsimIC.cxx
src/FDM/LaRCsimIC.hxx
-- similar to FGInitialCondition, this class has all the logic needed to
turn data like Vc and Mach into the more fundamental quantities LaRCsim
needs to initialize.
-- put it in src/FDM since it is a class
src/FDM/MagicCarpet.cxx
-- bus data members now directly assigned to
src/FDM/Makefile.am
-- adds LaRCsimIC.hxx and cxx
src/FDM/JSBSim/FGAtmosphere.h
src/FDM/JSBSim/FGDefs.h
src/FDM/JSBSim/FGInitialCondition.cpp
src/FDM/JSBSim/FGInitialCondition.h
src/FDM/JSBSim/JSBSim.cpp
-- changes to accomodate the new bus
src/FDM/LaRCsim/atmos_62.h
src/FDM/LaRCsim/ls_geodesy.h
-- surrounded prototypes with #ifdef __cplusplus ... #endif , functions
here are needed in LaRCsimIC
src/FDM/LaRCsim/c172_main.c
src/FDM/LaRCsim/cherokee_aero.c
src/FDM/LaRCsim/ls_aux.c
src/FDM/LaRCsim/ls_constants.h
src/FDM/LaRCsim/ls_geodesy.c
src/FDM/LaRCsim/ls_geodesy.h
src/FDM/LaRCsim/ls_step.c
src/FDM/UIUCModel/uiuc_betaprobe.cpp
-- changed PI to LS_PI, eliminates preprocessor naming conflict with
weather module
src/FDM/LaRCsim/ls_interface.c
src/FDM/LaRCsim/ls_interface.h
-- added function ls_set_model_dt()
src/Main/bfi.cxx
-- eliminated calls that set the NED speeds to body components. They
are no longer needed and confuse the new bus.
src/Main/fg_init.cxx
-- eliminated calls that just brought the bus data up-to-date (e.g.
set_sin_cos_latitude). or set default values. The bus now handles the
defaults and updates itself when the setters are called (for LaRCsim and
JSBSim). A default method for doing this needs to be added to the bus.
-- added fgVelocityInit() to set the speed the user asked for. Both
JSBSim and LaRCsim can now be initialized using any of:
vc,mach, NED components, UVW components.
src/Main/main.cxx
--eliminated call to fgFDMSetGroundElevation, this data is now 'pulled'
onto the bus every update()
src/Main/options.cxx
src/Main/options.hxx
-- added enum to keep track of the speed requested by the user
-- eliminated calls to set NED velocity properties to body speeds, they
are no longer needed.
-- added options for the NED components.
src/Network/garmin.cxx
src/Network/nmea.cxx
--eliminated calls that just brought the bus data up-to-date (e.g.
set_sin_cos_latitude). The bus now updates itself when the setters are
called (for LaRCsim and JSBSim). A default method for doing this needs
to be added to the bus.
-- changed set_V_equiv_kts to set_V_calibrated_kts. set_V_equiv_kts no
longer exists ( get_V_equiv_kts still does, though)
src/WeatherCM/FGLocalWeatherDatabase.cpp
-- commented out the code to put the weather data on the bus, a
different scheme for this is needed.
2000-10-24 00:34:50 +00:00
|
|
|
init_vec( d_pilot_rp_body_v );
|
|
|
|
init_vec( d_cg_rp_body_v );
|
|
|
|
init_vec( f_body_total_v );
|
|
|
|
init_vec( f_local_total_v );
|
|
|
|
init_vec( f_aero_v );
|
|
|
|
init_vec( f_engine_v );
|
|
|
|
init_vec( f_gear_v );
|
|
|
|
init_vec( m_total_rp_v );
|
|
|
|
init_vec( m_total_cg_v );
|
|
|
|
init_vec( m_aero_v );
|
|
|
|
init_vec( m_engine_v );
|
|
|
|
init_vec( m_gear_v );
|
|
|
|
init_vec( v_dot_local_v );
|
|
|
|
init_vec( v_dot_body_v );
|
|
|
|
init_vec( a_cg_body_v );
|
|
|
|
init_vec( a_pilot_body_v );
|
|
|
|
init_vec( n_cg_body_v );
|
|
|
|
init_vec( n_pilot_body_v );
|
|
|
|
init_vec( omega_dot_body_v );
|
|
|
|
init_vec( v_local_v );
|
|
|
|
init_vec( v_local_rel_ground_v );
|
|
|
|
init_vec( v_local_airmass_v );
|
|
|
|
init_vec( v_local_rel_airmass_v );
|
|
|
|
init_vec( v_local_gust_v );
|
|
|
|
init_vec( v_wind_body_v );
|
|
|
|
init_vec( omega_body_v );
|
|
|
|
init_vec( omega_local_v );
|
|
|
|
init_vec( omega_total_v );
|
|
|
|
init_vec( euler_rates_v );
|
|
|
|
init_vec( geocentric_rates_v );
|
|
|
|
init_vec( geocentric_position_v );
|
|
|
|
init_vec( geodetic_position_v );
|
|
|
|
init_vec( euler_angles_v );
|
|
|
|
init_vec( d_cg_rwy_local_v );
|
|
|
|
init_vec( d_cg_rwy_rwy_v );
|
|
|
|
init_vec( d_pilot_rwy_local_v );
|
|
|
|
init_vec( d_pilot_rwy_rwy_v );
|
|
|
|
init_vec( t_local_to_body_m[0] );
|
|
|
|
init_vec( t_local_to_body_m[1] );
|
|
|
|
init_vec( t_local_to_body_m[2] );
|
|
|
|
|
|
|
|
mass=i_xx=i_yy=i_zz=i_xz=0;
|
|
|
|
nlf=0;
|
|
|
|
v_rel_wind=v_true_kts=v_rel_ground=v_inertial=0;
|
|
|
|
v_ground_speed=v_equiv=v_equiv_kts=0;
|
|
|
|
v_calibrated=v_calibrated_kts=0;
|
|
|
|
gravity=0;
|
|
|
|
centrifugal_relief=0;
|
|
|
|
alpha=beta=alpha_dot=beta_dot=0;
|
|
|
|
cos_alpha=sin_alpha=cos_beta=sin_beta=0;
|
|
|
|
cos_phi=sin_phi=cos_theta=sin_theta=cos_psi=sin_psi=0;
|
|
|
|
gamma_vert_rad=gamma_horiz_rad=0;
|
|
|
|
sigma=density=v_sound=mach_number=0;
|
|
|
|
static_pressure=total_pressure=impact_pressure=0;
|
|
|
|
dynamic_pressure=0;
|
|
|
|
static_temperature=total_temperature=0;
|
|
|
|
sea_level_radius=earth_position_angle=0;
|
|
|
|
runway_altitude=runway_latitude=runway_longitude=0;
|
|
|
|
runway_heading=0;
|
|
|
|
radius_to_rwy=0;
|
|
|
|
climb_rate=0;
|
|
|
|
sin_lat_geocentric=cos_lat_geocentric=0;
|
|
|
|
sin_latitude=cos_latitude=0;
|
|
|
|
sin_longitude=cos_longitude=0;
|
|
|
|
altitude_agl=0;
|
2000-08-14 20:12:17 +00:00
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
// Destructor
|
|
|
|
FGInterface::~FGInterface() {
|
|
|
|
}
|
|
|
|
|
|
|
|
|
2000-10-16 14:54:41 +00:00
|
|
|
bool FGInterface::init( double dt ) {
|
1999-10-11 23:09:07 +00:00
|
|
|
cout << "dummy init() ... SHOULDN'T BE CALLED!" << endl;
|
2000-10-16 14:54:41 +00:00
|
|
|
return false;
|
1999-10-11 23:09:07 +00:00
|
|
|
}
|
|
|
|
|
2000-08-14 20:12:17 +00:00
|
|
|
|
2000-10-16 14:54:41 +00:00
|
|
|
bool FGInterface::update( int multi_loop ) {
|
1999-10-11 23:09:07 +00:00
|
|
|
cout << "dummy update() ... SHOULDN'T BE CALLED!" << endl;
|
2000-10-16 14:54:41 +00:00
|
|
|
return false;
|
1999-10-11 23:09:07 +00:00
|
|
|
}
|
|
|
|
|
2000-10-28 16:30:30 +00:00
|
|
|
|
|
|
|
void FGInterface::_updatePosition( double lat_geoc, double lon, double alt ) {
|
|
|
|
double lat_geod, tmp_alt, sl_radius1, sl_radius2, tmp_lat_geoc;
|
|
|
|
|
|
|
|
sgGeocToGeod( lat_geoc, EQUATORIAL_RADIUS_M + alt * FEET_TO_METER,
|
|
|
|
&lat_geod, &tmp_alt, &sl_radius1 );
|
|
|
|
sgGeodToGeoc( lat_geod, alt * FEET_TO_METER, &sl_radius2, &tmp_lat_geoc );
|
|
|
|
|
|
|
|
FG_LOG( FG_FLIGHT, FG_DEBUG, "lon = " << lon
|
|
|
|
<< " lat_geod = " << lat_geod
|
|
|
|
<< " lat_geoc = " << lat_geoc
|
|
|
|
<< " alt = " << alt
|
|
|
|
<< " tmp_alt = " << tmp_alt * METER_TO_FEET
|
|
|
|
<< " sl_radius1 = " << sl_radius1 * METER_TO_FEET
|
|
|
|
<< " sl_radius2 = " << sl_radius2 * METER_TO_FEET
|
|
|
|
<< " Equator = " << EQUATORIAL_RADIUS_FT );
|
|
|
|
|
|
|
|
_set_Geocentric_Position( lat_geoc, lon,
|
|
|
|
sl_radius2 * METER_TO_FEET + alt );
|
|
|
|
|
|
|
|
_set_Geodetic_Position( lat_geod, lon, alt );
|
|
|
|
|
|
|
|
_set_Sea_level_radius( sl_radius2 * METER_TO_FEET );
|
|
|
|
_set_Runway_altitude( scenery.cur_elev*METERS_TO_FEET );
|
|
|
|
|
|
|
|
_set_sin_lat_geocentric( lat_geoc );
|
|
|
|
_set_cos_lat_geocentric( lat_geoc );
|
|
|
|
|
|
|
|
_set_sin_cos_longitude( lon );
|
|
|
|
|
|
|
|
_set_sin_cos_latitude( lat_geod );
|
|
|
|
|
|
|
|
/* Norman's code for slope of the terrain */
|
|
|
|
/* needs to be tested -- get it on the HUD and taxi around */
|
|
|
|
/* double *tnorm = scenery.cur_normal;
|
|
|
|
|
|
|
|
double sy = sin ( -get_Psi() ) ;
|
|
|
|
double cy = cos ( -get_Psi() ) ;
|
|
|
|
|
|
|
|
double phitb, thetatb, psitb;
|
|
|
|
if(tnorm[1] != 0.0) {
|
|
|
|
psitb = -atan2 ( tnorm[0], tnorm[1] );
|
|
|
|
}
|
|
|
|
if(tnorm[2] != 0.0) {
|
|
|
|
thetatb = atan2 ( tnorm[0] * cy - tnorm[1] * sy, tnorm[2] );
|
|
|
|
phitb = -atan2 ( tnorm[1] * cy + tnorm[0] * sy, tnorm[2] );
|
|
|
|
}
|
|
|
|
|
|
|
|
_set_terrain_slope(phitb, thetatb, psitb)
|
|
|
|
*/
|
|
|
|
}
|
|
|
|
|
1999-10-11 23:09:07 +00:00
|
|
|
|
1999-01-19 17:52:06 +00:00
|
|
|
// Extrapolate fdm based on time_offset (in usec)
|
1999-02-05 21:28:09 +00:00
|
|
|
void FGInterface::extrapolate( int time_offset ) {
|
1999-01-19 17:52:06 +00:00
|
|
|
double dt = time_offset / 1000000.0;
|
1999-04-27 19:27:45 +00:00
|
|
|
|
|
|
|
// -dw- metrowerks complains about ambiguous access, not critical
|
|
|
|
// to keep this ;)
|
|
|
|
#ifndef __MWERKS__
|
1999-01-19 17:52:06 +00:00
|
|
|
cout << "extrapolating FDM by dt = " << dt << endl;
|
1999-04-27 19:27:45 +00:00
|
|
|
#endif
|
1999-01-19 17:52:06 +00:00
|
|
|
|
|
|
|
double lat = geodetic_position_v[0] + geocentric_rates_v[0] * dt;
|
|
|
|
double lat_geoc = geocentric_position_v[0] + geocentric_rates_v[0] * dt;
|
|
|
|
|
|
|
|
double lon = geodetic_position_v[1] + geocentric_rates_v[1] * dt;
|
|
|
|
double lon_geoc = geocentric_position_v[1] + geocentric_rates_v[1] * dt;
|
|
|
|
|
|
|
|
double alt = geodetic_position_v[2] + geocentric_rates_v[2] * dt;
|
|
|
|
double radius = geocentric_position_v[2] + geocentric_rates_v[2] * dt;
|
|
|
|
|
|
|
|
geodetic_position_v[0] = lat;
|
|
|
|
geocentric_position_v[0] = lat_geoc;
|
|
|
|
|
|
|
|
geodetic_position_v[1] = lon;
|
|
|
|
geocentric_position_v[1] = lon_geoc;
|
|
|
|
|
|
|
|
geodetic_position_v[2] = alt;
|
|
|
|
geocentric_position_v[2] = radius;
|
|
|
|
}
|
|
|
|
|
|
|
|
|
1998-12-04 01:29:37 +00:00
|
|
|
// Set the altitude (force)
|
1999-01-20 13:42:22 +00:00
|
|
|
void fgFDMForceAltitude(int model, double alt_meters) {
|
1998-07-12 03:08:27 +00:00
|
|
|
double sea_level_radius_meters;
|
|
|
|
double lat_geoc;
|
1999-01-08 03:23:51 +00:00
|
|
|
|
1998-07-12 03:08:27 +00:00
|
|
|
// Set the FG variables first
|
2000-09-27 20:16:22 +00:00
|
|
|
sgGeodToGeoc( base_fdm_state.get_Latitude(), alt_meters,
|
1998-07-12 03:08:27 +00:00
|
|
|
&sea_level_radius_meters, &lat_geoc);
|
|
|
|
|
1999-01-08 03:23:51 +00:00
|
|
|
base_fdm_state.set_Altitude( alt_meters * METER_TO_FEET );
|
I tested:
LaRCsim c172 on-ground and in-air starts, reset: all work
UIUC Cessna172 on-ground and in-air starts work as expected, reset
results in an aircraft that is upside down but does not crash FG. I
don't know what it was like before, so it may well be no change.
JSBSim c172 and X15 in-air starts work fine, resets now work (and are
trimmed), on-ground starts do not -- the c172 ends up on its back. I
suspect this is no worse than before.
I did not test:
Balloon (the weather code returns nan's for the atmosphere data --this
is in the weather module and apparently is a linux only bug)
ADA (don't know how)
MagicCarpet (needs work yet)
External (don't know how)
known to be broken:
LaRCsim c172 on-ground starts with a negative terrain altitude (this
happens at KPAO when the scenery is not present). The FDM inits to
about 50 feet AGL and the model falls to the ground. It does stay
upright, however, and seems to be fine once it settles out, FWIW.
To do:
--implement set_Model on the bus
--bring Christian's weather data into JSBSim
-- add default method to bus for updating things like the sin and cos of
latitude (for Balloon, MagicCarpet)
-- lots of cleanup
The files:
src/FDM/flight.cxx
src/FDM/flight.hxx
-- all data members now declared protected instead of private.
-- eliminated all but a small set of 'setters', no change to getters.
-- that small set is declared virtual, the default implementation
provided preserves the old behavior
-- all of the vector data members are now initialized.
-- added busdump() method -- FG_LOG's all the bus data when called,
useful for diagnostics.
src/FDM/ADA.cxx
-- bus data members now directly assigned to
src/FDM/Balloon.cxx
-- bus data members now directly assigned to
-- changed V_equiv_kts to V_calibrated_kts
src/FDM/JSBSim.cxx
src/FDM/JSBSim.hxx
-- bus data members now directly assigned to
-- implemented the FGInterface virtual setters with JSBSim specific
logic
-- changed the static FDMExec to a dynamic fdmex (needed so that the
JSBSim object can be deleted when a model change is called for)
-- implemented constructor and destructor, moved some of the logic
formerly in init() to constructor
-- added logic to bring up FGEngInterface objects and set the RPM and
throttle values.
src/FDM/LaRCsim.cxx
src/FDM/LaRCsim.hxx
-- bus data members now directly assigned to
-- implemented the FGInterface virtual setters with LaRCsim specific
logic, uses LaRCsimIC
-- implemented constructor and destructor, moved some of the logic
formerly in init() to constructor
-- moved default inertias to here from fg_init.cxx
-- eliminated the climb rate calculation. The equivalent, climb_rate =
-1*vdown, is now in copy_from_LaRCsim().
src/FDM/LaRCsimIC.cxx
src/FDM/LaRCsimIC.hxx
-- similar to FGInitialCondition, this class has all the logic needed to
turn data like Vc and Mach into the more fundamental quantities LaRCsim
needs to initialize.
-- put it in src/FDM since it is a class
src/FDM/MagicCarpet.cxx
-- bus data members now directly assigned to
src/FDM/Makefile.am
-- adds LaRCsimIC.hxx and cxx
src/FDM/JSBSim/FGAtmosphere.h
src/FDM/JSBSim/FGDefs.h
src/FDM/JSBSim/FGInitialCondition.cpp
src/FDM/JSBSim/FGInitialCondition.h
src/FDM/JSBSim/JSBSim.cpp
-- changes to accomodate the new bus
src/FDM/LaRCsim/atmos_62.h
src/FDM/LaRCsim/ls_geodesy.h
-- surrounded prototypes with #ifdef __cplusplus ... #endif , functions
here are needed in LaRCsimIC
src/FDM/LaRCsim/c172_main.c
src/FDM/LaRCsim/cherokee_aero.c
src/FDM/LaRCsim/ls_aux.c
src/FDM/LaRCsim/ls_constants.h
src/FDM/LaRCsim/ls_geodesy.c
src/FDM/LaRCsim/ls_geodesy.h
src/FDM/LaRCsim/ls_step.c
src/FDM/UIUCModel/uiuc_betaprobe.cpp
-- changed PI to LS_PI, eliminates preprocessor naming conflict with
weather module
src/FDM/LaRCsim/ls_interface.c
src/FDM/LaRCsim/ls_interface.h
-- added function ls_set_model_dt()
src/Main/bfi.cxx
-- eliminated calls that set the NED speeds to body components. They
are no longer needed and confuse the new bus.
src/Main/fg_init.cxx
-- eliminated calls that just brought the bus data up-to-date (e.g.
set_sin_cos_latitude). or set default values. The bus now handles the
defaults and updates itself when the setters are called (for LaRCsim and
JSBSim). A default method for doing this needs to be added to the bus.
-- added fgVelocityInit() to set the speed the user asked for. Both
JSBSim and LaRCsim can now be initialized using any of:
vc,mach, NED components, UVW components.
src/Main/main.cxx
--eliminated call to fgFDMSetGroundElevation, this data is now 'pulled'
onto the bus every update()
src/Main/options.cxx
src/Main/options.hxx
-- added enum to keep track of the speed requested by the user
-- eliminated calls to set NED velocity properties to body speeds, they
are no longer needed.
-- added options for the NED components.
src/Network/garmin.cxx
src/Network/nmea.cxx
--eliminated calls that just brought the bus data up-to-date (e.g.
set_sin_cos_latitude). The bus now updates itself when the setters are
called (for LaRCsim and JSBSim). A default method for doing this needs
to be added to the bus.
-- changed set_V_equiv_kts to set_V_calibrated_kts. set_V_equiv_kts no
longer exists ( get_V_equiv_kts still does, though)
src/WeatherCM/FGLocalWeatherDatabase.cpp
-- commented out the code to put the weather data on the bus, a
different scheme for this is needed.
2000-10-24 00:34:50 +00:00
|
|
|
base_fdm_state.set_Sea_level_radius( sea_level_radius_meters *
|
|
|
|
METER_TO_FEET );
|
|
|
|
|
1998-07-12 03:08:27 +00:00
|
|
|
|
1998-12-04 01:29:37 +00:00
|
|
|
// additional work needed for some flight models
|
1999-02-05 21:28:09 +00:00
|
|
|
if ( model == FGInterface::FG_LARCSIM ) {
|
1999-01-08 03:23:51 +00:00
|
|
|
ls_ForceAltitude( base_fdm_state.get_Altitude() );
|
1998-07-12 03:08:27 +00:00
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
|
1999-01-20 13:42:22 +00:00
|
|
|
// Set the local ground elevation
|
|
|
|
void fgFDMSetGroundElevation(int model, double ground_meters) {
|
I tested:
LaRCsim c172 on-ground and in-air starts, reset: all work
UIUC Cessna172 on-ground and in-air starts work as expected, reset
results in an aircraft that is upside down but does not crash FG. I
don't know what it was like before, so it may well be no change.
JSBSim c172 and X15 in-air starts work fine, resets now work (and are
trimmed), on-ground starts do not -- the c172 ends up on its back. I
suspect this is no worse than before.
I did not test:
Balloon (the weather code returns nan's for the atmosphere data --this
is in the weather module and apparently is a linux only bug)
ADA (don't know how)
MagicCarpet (needs work yet)
External (don't know how)
known to be broken:
LaRCsim c172 on-ground starts with a negative terrain altitude (this
happens at KPAO when the scenery is not present). The FDM inits to
about 50 feet AGL and the model falls to the ground. It does stay
upright, however, and seems to be fine once it settles out, FWIW.
To do:
--implement set_Model on the bus
--bring Christian's weather data into JSBSim
-- add default method to bus for updating things like the sin and cos of
latitude (for Balloon, MagicCarpet)
-- lots of cleanup
The files:
src/FDM/flight.cxx
src/FDM/flight.hxx
-- all data members now declared protected instead of private.
-- eliminated all but a small set of 'setters', no change to getters.
-- that small set is declared virtual, the default implementation
provided preserves the old behavior
-- all of the vector data members are now initialized.
-- added busdump() method -- FG_LOG's all the bus data when called,
useful for diagnostics.
src/FDM/ADA.cxx
-- bus data members now directly assigned to
src/FDM/Balloon.cxx
-- bus data members now directly assigned to
-- changed V_equiv_kts to V_calibrated_kts
src/FDM/JSBSim.cxx
src/FDM/JSBSim.hxx
-- bus data members now directly assigned to
-- implemented the FGInterface virtual setters with JSBSim specific
logic
-- changed the static FDMExec to a dynamic fdmex (needed so that the
JSBSim object can be deleted when a model change is called for)
-- implemented constructor and destructor, moved some of the logic
formerly in init() to constructor
-- added logic to bring up FGEngInterface objects and set the RPM and
throttle values.
src/FDM/LaRCsim.cxx
src/FDM/LaRCsim.hxx
-- bus data members now directly assigned to
-- implemented the FGInterface virtual setters with LaRCsim specific
logic, uses LaRCsimIC
-- implemented constructor and destructor, moved some of the logic
formerly in init() to constructor
-- moved default inertias to here from fg_init.cxx
-- eliminated the climb rate calculation. The equivalent, climb_rate =
-1*vdown, is now in copy_from_LaRCsim().
src/FDM/LaRCsimIC.cxx
src/FDM/LaRCsimIC.hxx
-- similar to FGInitialCondition, this class has all the logic needed to
turn data like Vc and Mach into the more fundamental quantities LaRCsim
needs to initialize.
-- put it in src/FDM since it is a class
src/FDM/MagicCarpet.cxx
-- bus data members now directly assigned to
src/FDM/Makefile.am
-- adds LaRCsimIC.hxx and cxx
src/FDM/JSBSim/FGAtmosphere.h
src/FDM/JSBSim/FGDefs.h
src/FDM/JSBSim/FGInitialCondition.cpp
src/FDM/JSBSim/FGInitialCondition.h
src/FDM/JSBSim/JSBSim.cpp
-- changes to accomodate the new bus
src/FDM/LaRCsim/atmos_62.h
src/FDM/LaRCsim/ls_geodesy.h
-- surrounded prototypes with #ifdef __cplusplus ... #endif , functions
here are needed in LaRCsimIC
src/FDM/LaRCsim/c172_main.c
src/FDM/LaRCsim/cherokee_aero.c
src/FDM/LaRCsim/ls_aux.c
src/FDM/LaRCsim/ls_constants.h
src/FDM/LaRCsim/ls_geodesy.c
src/FDM/LaRCsim/ls_geodesy.h
src/FDM/LaRCsim/ls_step.c
src/FDM/UIUCModel/uiuc_betaprobe.cpp
-- changed PI to LS_PI, eliminates preprocessor naming conflict with
weather module
src/FDM/LaRCsim/ls_interface.c
src/FDM/LaRCsim/ls_interface.h
-- added function ls_set_model_dt()
src/Main/bfi.cxx
-- eliminated calls that set the NED speeds to body components. They
are no longer needed and confuse the new bus.
src/Main/fg_init.cxx
-- eliminated calls that just brought the bus data up-to-date (e.g.
set_sin_cos_latitude). or set default values. The bus now handles the
defaults and updates itself when the setters are called (for LaRCsim and
JSBSim). A default method for doing this needs to be added to the bus.
-- added fgVelocityInit() to set the speed the user asked for. Both
JSBSim and LaRCsim can now be initialized using any of:
vc,mach, NED components, UVW components.
src/Main/main.cxx
--eliminated call to fgFDMSetGroundElevation, this data is now 'pulled'
onto the bus every update()
src/Main/options.cxx
src/Main/options.hxx
-- added enum to keep track of the speed requested by the user
-- eliminated calls to set NED velocity properties to body speeds, they
are no longer needed.
-- added options for the NED components.
src/Network/garmin.cxx
src/Network/nmea.cxx
--eliminated calls that just brought the bus data up-to-date (e.g.
set_sin_cos_latitude). The bus now updates itself when the setters are
called (for LaRCsim and JSBSim). A default method for doing this needs
to be added to the bus.
-- changed set_V_equiv_kts to set_V_calibrated_kts. set_V_equiv_kts no
longer exists ( get_V_equiv_kts still does, though)
src/WeatherCM/FGLocalWeatherDatabase.cpp
-- commented out the code to put the weather data on the bus, a
different scheme for this is needed.
2000-10-24 00:34:50 +00:00
|
|
|
FG_LOG( FG_FLIGHT,FG_INFO, "fgFDMSetGroundElevation: "
|
|
|
|
<< ground_meters*METER_TO_FEET );
|
1999-01-20 13:42:22 +00:00
|
|
|
base_fdm_state.set_Runway_altitude( ground_meters * METER_TO_FEET );
|
1999-10-11 23:09:07 +00:00
|
|
|
cur_fdm_state->set_Runway_altitude( ground_meters * METER_TO_FEET );
|
1999-01-20 13:42:22 +00:00
|
|
|
}
|
|
|
|
|
|
|
|
|
I tested:
LaRCsim c172 on-ground and in-air starts, reset: all work
UIUC Cessna172 on-ground and in-air starts work as expected, reset
results in an aircraft that is upside down but does not crash FG. I
don't know what it was like before, so it may well be no change.
JSBSim c172 and X15 in-air starts work fine, resets now work (and are
trimmed), on-ground starts do not -- the c172 ends up on its back. I
suspect this is no worse than before.
I did not test:
Balloon (the weather code returns nan's for the atmosphere data --this
is in the weather module and apparently is a linux only bug)
ADA (don't know how)
MagicCarpet (needs work yet)
External (don't know how)
known to be broken:
LaRCsim c172 on-ground starts with a negative terrain altitude (this
happens at KPAO when the scenery is not present). The FDM inits to
about 50 feet AGL and the model falls to the ground. It does stay
upright, however, and seems to be fine once it settles out, FWIW.
To do:
--implement set_Model on the bus
--bring Christian's weather data into JSBSim
-- add default method to bus for updating things like the sin and cos of
latitude (for Balloon, MagicCarpet)
-- lots of cleanup
The files:
src/FDM/flight.cxx
src/FDM/flight.hxx
-- all data members now declared protected instead of private.
-- eliminated all but a small set of 'setters', no change to getters.
-- that small set is declared virtual, the default implementation
provided preserves the old behavior
-- all of the vector data members are now initialized.
-- added busdump() method -- FG_LOG's all the bus data when called,
useful for diagnostics.
src/FDM/ADA.cxx
-- bus data members now directly assigned to
src/FDM/Balloon.cxx
-- bus data members now directly assigned to
-- changed V_equiv_kts to V_calibrated_kts
src/FDM/JSBSim.cxx
src/FDM/JSBSim.hxx
-- bus data members now directly assigned to
-- implemented the FGInterface virtual setters with JSBSim specific
logic
-- changed the static FDMExec to a dynamic fdmex (needed so that the
JSBSim object can be deleted when a model change is called for)
-- implemented constructor and destructor, moved some of the logic
formerly in init() to constructor
-- added logic to bring up FGEngInterface objects and set the RPM and
throttle values.
src/FDM/LaRCsim.cxx
src/FDM/LaRCsim.hxx
-- bus data members now directly assigned to
-- implemented the FGInterface virtual setters with LaRCsim specific
logic, uses LaRCsimIC
-- implemented constructor and destructor, moved some of the logic
formerly in init() to constructor
-- moved default inertias to here from fg_init.cxx
-- eliminated the climb rate calculation. The equivalent, climb_rate =
-1*vdown, is now in copy_from_LaRCsim().
src/FDM/LaRCsimIC.cxx
src/FDM/LaRCsimIC.hxx
-- similar to FGInitialCondition, this class has all the logic needed to
turn data like Vc and Mach into the more fundamental quantities LaRCsim
needs to initialize.
-- put it in src/FDM since it is a class
src/FDM/MagicCarpet.cxx
-- bus data members now directly assigned to
src/FDM/Makefile.am
-- adds LaRCsimIC.hxx and cxx
src/FDM/JSBSim/FGAtmosphere.h
src/FDM/JSBSim/FGDefs.h
src/FDM/JSBSim/FGInitialCondition.cpp
src/FDM/JSBSim/FGInitialCondition.h
src/FDM/JSBSim/JSBSim.cpp
-- changes to accomodate the new bus
src/FDM/LaRCsim/atmos_62.h
src/FDM/LaRCsim/ls_geodesy.h
-- surrounded prototypes with #ifdef __cplusplus ... #endif , functions
here are needed in LaRCsimIC
src/FDM/LaRCsim/c172_main.c
src/FDM/LaRCsim/cherokee_aero.c
src/FDM/LaRCsim/ls_aux.c
src/FDM/LaRCsim/ls_constants.h
src/FDM/LaRCsim/ls_geodesy.c
src/FDM/LaRCsim/ls_geodesy.h
src/FDM/LaRCsim/ls_step.c
src/FDM/UIUCModel/uiuc_betaprobe.cpp
-- changed PI to LS_PI, eliminates preprocessor naming conflict with
weather module
src/FDM/LaRCsim/ls_interface.c
src/FDM/LaRCsim/ls_interface.h
-- added function ls_set_model_dt()
src/Main/bfi.cxx
-- eliminated calls that set the NED speeds to body components. They
are no longer needed and confuse the new bus.
src/Main/fg_init.cxx
-- eliminated calls that just brought the bus data up-to-date (e.g.
set_sin_cos_latitude). or set default values. The bus now handles the
defaults and updates itself when the setters are called (for LaRCsim and
JSBSim). A default method for doing this needs to be added to the bus.
-- added fgVelocityInit() to set the speed the user asked for. Both
JSBSim and LaRCsim can now be initialized using any of:
vc,mach, NED components, UVW components.
src/Main/main.cxx
--eliminated call to fgFDMSetGroundElevation, this data is now 'pulled'
onto the bus every update()
src/Main/options.cxx
src/Main/options.hxx
-- added enum to keep track of the speed requested by the user
-- eliminated calls to set NED velocity properties to body speeds, they
are no longer needed.
-- added options for the NED components.
src/Network/garmin.cxx
src/Network/nmea.cxx
--eliminated calls that just brought the bus data up-to-date (e.g.
set_sin_cos_latitude). The bus now updates itself when the setters are
called (for LaRCsim and JSBSim). A default method for doing this needs
to be added to the bus.
-- changed set_V_equiv_kts to set_V_calibrated_kts. set_V_equiv_kts no
longer exists ( get_V_equiv_kts still does, though)
src/WeatherCM/FGLocalWeatherDatabase.cpp
-- commented out the code to put the weather data on the bus, a
different scheme for this is needed.
2000-10-24 00:34:50 +00:00
|
|
|
// Positions
|
|
|
|
void FGInterface::set_Latitude(double lat) {
|
|
|
|
geodetic_position_v[0] = lat;
|
|
|
|
}
|
|
|
|
|
|
|
|
void FGInterface::set_Longitude(double lon) {
|
|
|
|
geodetic_position_v[1] = lon;
|
|
|
|
}
|
|
|
|
|
|
|
|
void FGInterface::set_Altitude(double alt) {
|
|
|
|
geodetic_position_v[2] = alt;
|
|
|
|
}
|
|
|
|
|
|
|
|
void FGInterface::set_AltitudeAGL(double altagl) {
|
|
|
|
altitude_agl=altagl;
|
|
|
|
}
|
|
|
|
|
|
|
|
// Velocities
|
|
|
|
void FGInterface::set_V_calibrated_kts(double vc) {
|
|
|
|
v_calibrated_kts = vc;
|
|
|
|
}
|
|
|
|
|
|
|
|
void FGInterface::set_Mach_number(double mach) {
|
|
|
|
mach_number = mach;
|
|
|
|
}
|
|
|
|
|
|
|
|
void FGInterface::set_Velocities_Local( double north,
|
|
|
|
double east,
|
|
|
|
double down ){
|
|
|
|
v_local_v[0] = north;
|
|
|
|
v_local_v[1] = east;
|
|
|
|
v_local_v[2] = down;
|
|
|
|
}
|
|
|
|
|
|
|
|
void FGInterface::set_Velocities_Wind_Body( double u,
|
|
|
|
double v,
|
|
|
|
double w){
|
|
|
|
v_wind_body_v[0] = u;
|
|
|
|
v_wind_body_v[1] = v;
|
|
|
|
v_wind_body_v[2] = w;
|
|
|
|
}
|
|
|
|
|
|
|
|
// Euler angles
|
|
|
|
void FGInterface::set_Euler_Angles( double phi,
|
|
|
|
double theta,
|
|
|
|
double psi ) {
|
|
|
|
euler_angles_v[0] = phi;
|
|
|
|
euler_angles_v[1] = theta;
|
|
|
|
euler_angles_v[2] = psi;
|
|
|
|
}
|
|
|
|
|
|
|
|
// Flight Path
|
|
|
|
void FGInterface::set_Climb_Rate( double roc) {
|
|
|
|
climb_rate = roc;
|
|
|
|
}
|
|
|
|
|
|
|
|
void FGInterface::set_Gamma_vert_rad( double gamma) {
|
|
|
|
gamma_vert_rad = gamma;
|
|
|
|
}
|
|
|
|
|
|
|
|
// Earth
|
|
|
|
void FGInterface::set_Sea_level_radius(double slr) {
|
|
|
|
sea_level_radius = slr;
|
|
|
|
}
|
|
|
|
|
|
|
|
void FGInterface::set_Runway_altitude(double ralt) {
|
|
|
|
runway_altitude = ralt;
|
|
|
|
}
|
|
|
|
|
|
|
|
void FGInterface::set_Static_pressure(double p) { static_pressure = p; }
|
|
|
|
void FGInterface::set_Static_temperature(double T) { static_temperature = T; }
|
|
|
|
void FGInterface::set_Density(double rho) { density = rho; }
|
|
|
|
|
|
|
|
void FGInterface::set_Velocities_Local_Airmass (double wnorth,
|
|
|
|
double weast,
|
|
|
|
double wdown ) {
|
|
|
|
v_local_airmass_v[0] = wnorth;
|
|
|
|
v_local_airmass_v[1] = weast;
|
|
|
|
v_local_airmass_v[2] = wdown;
|
|
|
|
}
|
|
|
|
|
|
|
|
|
2000-10-28 16:30:30 +00:00
|
|
|
void FGInterface::_busdump(void) {
|
I tested:
LaRCsim c172 on-ground and in-air starts, reset: all work
UIUC Cessna172 on-ground and in-air starts work as expected, reset
results in an aircraft that is upside down but does not crash FG. I
don't know what it was like before, so it may well be no change.
JSBSim c172 and X15 in-air starts work fine, resets now work (and are
trimmed), on-ground starts do not -- the c172 ends up on its back. I
suspect this is no worse than before.
I did not test:
Balloon (the weather code returns nan's for the atmosphere data --this
is in the weather module and apparently is a linux only bug)
ADA (don't know how)
MagicCarpet (needs work yet)
External (don't know how)
known to be broken:
LaRCsim c172 on-ground starts with a negative terrain altitude (this
happens at KPAO when the scenery is not present). The FDM inits to
about 50 feet AGL and the model falls to the ground. It does stay
upright, however, and seems to be fine once it settles out, FWIW.
To do:
--implement set_Model on the bus
--bring Christian's weather data into JSBSim
-- add default method to bus for updating things like the sin and cos of
latitude (for Balloon, MagicCarpet)
-- lots of cleanup
The files:
src/FDM/flight.cxx
src/FDM/flight.hxx
-- all data members now declared protected instead of private.
-- eliminated all but a small set of 'setters', no change to getters.
-- that small set is declared virtual, the default implementation
provided preserves the old behavior
-- all of the vector data members are now initialized.
-- added busdump() method -- FG_LOG's all the bus data when called,
useful for diagnostics.
src/FDM/ADA.cxx
-- bus data members now directly assigned to
src/FDM/Balloon.cxx
-- bus data members now directly assigned to
-- changed V_equiv_kts to V_calibrated_kts
src/FDM/JSBSim.cxx
src/FDM/JSBSim.hxx
-- bus data members now directly assigned to
-- implemented the FGInterface virtual setters with JSBSim specific
logic
-- changed the static FDMExec to a dynamic fdmex (needed so that the
JSBSim object can be deleted when a model change is called for)
-- implemented constructor and destructor, moved some of the logic
formerly in init() to constructor
-- added logic to bring up FGEngInterface objects and set the RPM and
throttle values.
src/FDM/LaRCsim.cxx
src/FDM/LaRCsim.hxx
-- bus data members now directly assigned to
-- implemented the FGInterface virtual setters with LaRCsim specific
logic, uses LaRCsimIC
-- implemented constructor and destructor, moved some of the logic
formerly in init() to constructor
-- moved default inertias to here from fg_init.cxx
-- eliminated the climb rate calculation. The equivalent, climb_rate =
-1*vdown, is now in copy_from_LaRCsim().
src/FDM/LaRCsimIC.cxx
src/FDM/LaRCsimIC.hxx
-- similar to FGInitialCondition, this class has all the logic needed to
turn data like Vc and Mach into the more fundamental quantities LaRCsim
needs to initialize.
-- put it in src/FDM since it is a class
src/FDM/MagicCarpet.cxx
-- bus data members now directly assigned to
src/FDM/Makefile.am
-- adds LaRCsimIC.hxx and cxx
src/FDM/JSBSim/FGAtmosphere.h
src/FDM/JSBSim/FGDefs.h
src/FDM/JSBSim/FGInitialCondition.cpp
src/FDM/JSBSim/FGInitialCondition.h
src/FDM/JSBSim/JSBSim.cpp
-- changes to accomodate the new bus
src/FDM/LaRCsim/atmos_62.h
src/FDM/LaRCsim/ls_geodesy.h
-- surrounded prototypes with #ifdef __cplusplus ... #endif , functions
here are needed in LaRCsimIC
src/FDM/LaRCsim/c172_main.c
src/FDM/LaRCsim/cherokee_aero.c
src/FDM/LaRCsim/ls_aux.c
src/FDM/LaRCsim/ls_constants.h
src/FDM/LaRCsim/ls_geodesy.c
src/FDM/LaRCsim/ls_geodesy.h
src/FDM/LaRCsim/ls_step.c
src/FDM/UIUCModel/uiuc_betaprobe.cpp
-- changed PI to LS_PI, eliminates preprocessor naming conflict with
weather module
src/FDM/LaRCsim/ls_interface.c
src/FDM/LaRCsim/ls_interface.h
-- added function ls_set_model_dt()
src/Main/bfi.cxx
-- eliminated calls that set the NED speeds to body components. They
are no longer needed and confuse the new bus.
src/Main/fg_init.cxx
-- eliminated calls that just brought the bus data up-to-date (e.g.
set_sin_cos_latitude). or set default values. The bus now handles the
defaults and updates itself when the setters are called (for LaRCsim and
JSBSim). A default method for doing this needs to be added to the bus.
-- added fgVelocityInit() to set the speed the user asked for. Both
JSBSim and LaRCsim can now be initialized using any of:
vc,mach, NED components, UVW components.
src/Main/main.cxx
--eliminated call to fgFDMSetGroundElevation, this data is now 'pulled'
onto the bus every update()
src/Main/options.cxx
src/Main/options.hxx
-- added enum to keep track of the speed requested by the user
-- eliminated calls to set NED velocity properties to body speeds, they
are no longer needed.
-- added options for the NED components.
src/Network/garmin.cxx
src/Network/nmea.cxx
--eliminated calls that just brought the bus data up-to-date (e.g.
set_sin_cos_latitude). The bus now updates itself when the setters are
called (for LaRCsim and JSBSim). A default method for doing this needs
to be added to the bus.
-- changed set_V_equiv_kts to set_V_calibrated_kts. set_V_equiv_kts no
longer exists ( get_V_equiv_kts still does, though)
src/WeatherCM/FGLocalWeatherDatabase.cpp
-- commented out the code to put the weather data on the bus, a
different scheme for this is needed.
2000-10-24 00:34:50 +00:00
|
|
|
|
|
|
|
FG_LOG(FG_FLIGHT,FG_INFO,"d_pilot_rp_body_v[3]: " << d_pilot_rp_body_v[0] << ", " << d_pilot_rp_body_v[1] << ", " << d_pilot_rp_body_v[2]);
|
|
|
|
FG_LOG(FG_FLIGHT,FG_INFO,"d_cg_rp_body_v[3]: " << d_cg_rp_body_v[0] << ", " << d_cg_rp_body_v[1] << ", " << d_cg_rp_body_v[2]);
|
|
|
|
FG_LOG(FG_FLIGHT,FG_INFO,"f_body_total_v[3]: " << f_body_total_v[0] << ", " << f_body_total_v[1] << ", " << f_body_total_v[2]);
|
|
|
|
FG_LOG(FG_FLIGHT,FG_INFO,"f_local_total_v[3]: " << f_local_total_v[0] << ", " << f_local_total_v[1] << ", " << f_local_total_v[2]);
|
|
|
|
FG_LOG(FG_FLIGHT,FG_INFO,"f_aero_v[3]: " << f_aero_v[0] << ", " << f_aero_v[1] << ", " << f_aero_v[2]);
|
|
|
|
FG_LOG(FG_FLIGHT,FG_INFO,"f_engine_v[3]: " << f_engine_v[0] << ", " << f_engine_v[1] << ", " << f_engine_v[2]);
|
|
|
|
FG_LOG(FG_FLIGHT,FG_INFO,"f_gear_v[3]: " << f_gear_v[0] << ", " << f_gear_v[1] << ", " << f_gear_v[2]);
|
|
|
|
FG_LOG(FG_FLIGHT,FG_INFO,"m_total_rp_v[3]: " << m_total_rp_v[0] << ", " << m_total_rp_v[1] << ", " << m_total_rp_v[2]);
|
|
|
|
FG_LOG(FG_FLIGHT,FG_INFO,"m_total_cg_v[3]: " << m_total_cg_v[0] << ", " << m_total_cg_v[1] << ", " << m_total_cg_v[2]);
|
|
|
|
FG_LOG(FG_FLIGHT,FG_INFO,"m_aero_v[3]: " << m_aero_v[0] << ", " << m_aero_v[1] << ", " << m_aero_v[2]);
|
|
|
|
FG_LOG(FG_FLIGHT,FG_INFO,"m_engine_v[3]: " << m_engine_v[0] << ", " << m_engine_v[1] << ", " << m_engine_v[2]);
|
|
|
|
FG_LOG(FG_FLIGHT,FG_INFO,"m_gear_v[3]: " << m_gear_v[0] << ", " << m_gear_v[1] << ", " << m_gear_v[2]);
|
|
|
|
FG_LOG(FG_FLIGHT,FG_INFO,"v_dot_local_v[3]: " << v_dot_local_v[0] << ", " << v_dot_local_v[1] << ", " << v_dot_local_v[2]);
|
|
|
|
FG_LOG(FG_FLIGHT,FG_INFO,"v_dot_body_v[3]: " << v_dot_body_v[0] << ", " << v_dot_body_v[1] << ", " << v_dot_body_v[2]);
|
|
|
|
FG_LOG(FG_FLIGHT,FG_INFO,"a_cg_body_v[3]: " << a_cg_body_v[0] << ", " << a_cg_body_v[1] << ", " << a_cg_body_v[2]);
|
|
|
|
FG_LOG(FG_FLIGHT,FG_INFO,"a_pilot_body_v[3]: " << a_pilot_body_v[0] << ", " << a_pilot_body_v[1] << ", " << a_pilot_body_v[2]);
|
|
|
|
FG_LOG(FG_FLIGHT,FG_INFO,"n_cg_body_v[3]: " << n_cg_body_v[0] << ", " << n_cg_body_v[1] << ", " << n_cg_body_v[2]);
|
|
|
|
FG_LOG(FG_FLIGHT,FG_INFO,"n_pilot_body_v[3]: " << n_pilot_body_v[0] << ", " << n_pilot_body_v[1] << ", " << n_pilot_body_v[2]);
|
|
|
|
FG_LOG(FG_FLIGHT,FG_INFO,"omega_dot_body_v[3]: " << omega_dot_body_v[0] << ", " << omega_dot_body_v[1] << ", " << omega_dot_body_v[2]);
|
|
|
|
FG_LOG(FG_FLIGHT,FG_INFO,"v_local_v[3]: " << v_local_v[0] << ", " << v_local_v[1] << ", " << v_local_v[2]);
|
|
|
|
FG_LOG(FG_FLIGHT,FG_INFO,"v_local_rel_ground_v[3]: " << v_local_rel_ground_v[0] << ", " << v_local_rel_ground_v[1] << ", " << v_local_rel_ground_v[2]);
|
|
|
|
FG_LOG(FG_FLIGHT,FG_INFO,"v_local_airmass_v[3]: " << v_local_airmass_v[0] << ", " << v_local_airmass_v[1] << ", " << v_local_airmass_v[2]);
|
|
|
|
FG_LOG(FG_FLIGHT,FG_INFO,"v_local_rel_airmass_v[3]: " << v_local_rel_airmass_v[0] << ", " << v_local_rel_airmass_v[1] << ", " << v_local_rel_airmass_v[2]);
|
|
|
|
FG_LOG(FG_FLIGHT,FG_INFO,"v_local_gust_v[3]: " << v_local_gust_v[0] << ", " << v_local_gust_v[1] << ", " << v_local_gust_v[2]);
|
|
|
|
FG_LOG(FG_FLIGHT,FG_INFO,"v_wind_body_v[3]: " << v_wind_body_v[0] << ", " << v_wind_body_v[1] << ", " << v_wind_body_v[2]);
|
|
|
|
FG_LOG(FG_FLIGHT,FG_INFO,"omega_body_v[3]: " << omega_body_v[0] << ", " << omega_body_v[1] << ", " << omega_body_v[2]);
|
|
|
|
FG_LOG(FG_FLIGHT,FG_INFO,"omega_local_v[3]: " << omega_local_v[0] << ", " << omega_local_v[1] << ", " << omega_local_v[2]);
|
|
|
|
FG_LOG(FG_FLIGHT,FG_INFO,"omega_total_v[3]: " << omega_total_v[0] << ", " << omega_total_v[1] << ", " << omega_total_v[2]);
|
|
|
|
FG_LOG(FG_FLIGHT,FG_INFO,"euler_rates_v[3]: " << euler_rates_v[0] << ", " << euler_rates_v[1] << ", " << euler_rates_v[2]);
|
|
|
|
FG_LOG(FG_FLIGHT,FG_INFO,"geocentric_rates_v[3]: " << geocentric_rates_v[0] << ", " << geocentric_rates_v[1] << ", " << geocentric_rates_v[2]);
|
|
|
|
FG_LOG(FG_FLIGHT,FG_INFO,"geocentric_position_v[3]: " << geocentric_position_v[0] << ", " << geocentric_position_v[1] << ", " << geocentric_position_v[2]);
|
|
|
|
FG_LOG(FG_FLIGHT,FG_INFO,"geodetic_position_v[3]: " << geodetic_position_v[0] << ", " << geodetic_position_v[1] << ", " << geodetic_position_v[2]);
|
|
|
|
FG_LOG(FG_FLIGHT,FG_INFO,"euler_angles_v[3]: " << euler_angles_v[0] << ", " << euler_angles_v[1] << ", " << euler_angles_v[2]);
|
|
|
|
FG_LOG(FG_FLIGHT,FG_INFO,"d_cg_rwy_local_v[3]: " << d_cg_rwy_local_v[0] << ", " << d_cg_rwy_local_v[1] << ", " << d_cg_rwy_local_v[2]);
|
|
|
|
FG_LOG(FG_FLIGHT,FG_INFO,"d_cg_rwy_rwy_v[3]: " << d_cg_rwy_rwy_v[0] << ", " << d_cg_rwy_rwy_v[1] << ", " << d_cg_rwy_rwy_v[2]);
|
|
|
|
FG_LOG(FG_FLIGHT,FG_INFO,"d_pilot_rwy_local_v[3]: " << d_pilot_rwy_local_v[0] << ", " << d_pilot_rwy_local_v[1] << ", " << d_pilot_rwy_local_v[2]);
|
|
|
|
FG_LOG(FG_FLIGHT,FG_INFO,"d_pilot_rwy_rwy_v[3]: " << d_pilot_rwy_rwy_v[0] << ", " << d_pilot_rwy_rwy_v[1] << ", " << d_pilot_rwy_rwy_v[2]);
|
|
|
|
|
|
|
|
FG_LOG(FG_FLIGHT,FG_INFO,"t_local_to_body_m[0][3]: " << t_local_to_body_m[0][0] << ", " << t_local_to_body_m[0][1] << ", " << t_local_to_body_m[0][2]);
|
|
|
|
FG_LOG(FG_FLIGHT,FG_INFO,"t_local_to_body_m[1][3]: " << t_local_to_body_m[1][0] << ", " << t_local_to_body_m[1][1] << ", " << t_local_to_body_m[1][2]);
|
|
|
|
FG_LOG(FG_FLIGHT,FG_INFO,"t_local_to_body_m[2][3]: " << t_local_to_body_m[2][0] << ", " << t_local_to_body_m[2][1] << ", " << t_local_to_body_m[2][2]);
|
|
|
|
|
|
|
|
FG_LOG(FG_FLIGHT,FG_INFO,"mass: " << mass );
|
|
|
|
FG_LOG(FG_FLIGHT,FG_INFO,"i_xx: " << i_xx );
|
|
|
|
FG_LOG(FG_FLIGHT,FG_INFO,"i_yy: " << i_yy );
|
|
|
|
FG_LOG(FG_FLIGHT,FG_INFO,"i_zz: " << i_zz );
|
|
|
|
FG_LOG(FG_FLIGHT,FG_INFO,"i_xz: " << i_xz );
|
|
|
|
FG_LOG(FG_FLIGHT,FG_INFO,"nlf: " << nlf );
|
|
|
|
FG_LOG(FG_FLIGHT,FG_INFO,"v_rel_wind: " << v_rel_wind );
|
|
|
|
FG_LOG(FG_FLIGHT,FG_INFO,"v_true_kts: " << v_true_kts );
|
|
|
|
FG_LOG(FG_FLIGHT,FG_INFO,"v_rel_ground: " << v_rel_ground );
|
|
|
|
FG_LOG(FG_FLIGHT,FG_INFO,"v_inertial: " << v_inertial );
|
|
|
|
FG_LOG(FG_FLIGHT,FG_INFO,"v_ground_speed: " << v_ground_speed );
|
|
|
|
FG_LOG(FG_FLIGHT,FG_INFO,"v_equiv: " << v_equiv );
|
|
|
|
FG_LOG(FG_FLIGHT,FG_INFO,"v_equiv_kts: " << v_equiv_kts );
|
|
|
|
FG_LOG(FG_FLIGHT,FG_INFO,"v_calibrated: " << v_calibrated );
|
|
|
|
FG_LOG(FG_FLIGHT,FG_INFO,"v_calibrated_kts: " << v_calibrated_kts );
|
|
|
|
FG_LOG(FG_FLIGHT,FG_INFO,"gravity: " << gravity );
|
|
|
|
FG_LOG(FG_FLIGHT,FG_INFO,"centrifugal_relief: " << centrifugal_relief );
|
|
|
|
FG_LOG(FG_FLIGHT,FG_INFO,"alpha: " << alpha );
|
|
|
|
FG_LOG(FG_FLIGHT,FG_INFO,"beta: " << beta );
|
|
|
|
FG_LOG(FG_FLIGHT,FG_INFO,"alpha_dot: " << alpha_dot );
|
|
|
|
FG_LOG(FG_FLIGHT,FG_INFO,"beta_dot: " << beta_dot );
|
|
|
|
FG_LOG(FG_FLIGHT,FG_INFO,"cos_alpha: " << cos_alpha );
|
|
|
|
FG_LOG(FG_FLIGHT,FG_INFO,"sin_alpha: " << sin_alpha );
|
|
|
|
FG_LOG(FG_FLIGHT,FG_INFO,"cos_beta: " << cos_beta );
|
|
|
|
FG_LOG(FG_FLIGHT,FG_INFO,"sin_beta: " << sin_beta );
|
|
|
|
FG_LOG(FG_FLIGHT,FG_INFO,"cos_phi: " << cos_phi );
|
|
|
|
FG_LOG(FG_FLIGHT,FG_INFO,"sin_phi: " << sin_phi );
|
|
|
|
FG_LOG(FG_FLIGHT,FG_INFO,"cos_theta: " << cos_theta );
|
|
|
|
FG_LOG(FG_FLIGHT,FG_INFO,"sin_theta: " << sin_theta );
|
|
|
|
FG_LOG(FG_FLIGHT,FG_INFO,"cos_psi: " << cos_psi );
|
|
|
|
FG_LOG(FG_FLIGHT,FG_INFO,"sin_psi: " << sin_psi );
|
|
|
|
FG_LOG(FG_FLIGHT,FG_INFO,"gamma_vert_rad: " << gamma_vert_rad );
|
|
|
|
FG_LOG(FG_FLIGHT,FG_INFO,"gamma_horiz_rad: " << gamma_horiz_rad );
|
|
|
|
FG_LOG(FG_FLIGHT,FG_INFO,"sigma: " << sigma );
|
|
|
|
FG_LOG(FG_FLIGHT,FG_INFO,"density: " << density );
|
|
|
|
FG_LOG(FG_FLIGHT,FG_INFO,"v_sound: " << v_sound );
|
|
|
|
FG_LOG(FG_FLIGHT,FG_INFO,"mach_number: " << mach_number );
|
|
|
|
FG_LOG(FG_FLIGHT,FG_INFO,"static_pressure: " << static_pressure );
|
|
|
|
FG_LOG(FG_FLIGHT,FG_INFO,"total_pressure: " << total_pressure );
|
|
|
|
FG_LOG(FG_FLIGHT,FG_INFO,"impact_pressure: " << impact_pressure );
|
|
|
|
FG_LOG(FG_FLIGHT,FG_INFO,"dynamic_pressure: " << dynamic_pressure );
|
|
|
|
FG_LOG(FG_FLIGHT,FG_INFO,"static_temperature: " << static_temperature );
|
|
|
|
FG_LOG(FG_FLIGHT,FG_INFO,"total_temperature: " << total_temperature );
|
|
|
|
FG_LOG(FG_FLIGHT,FG_INFO,"sea_level_radius: " << sea_level_radius );
|
|
|
|
FG_LOG(FG_FLIGHT,FG_INFO,"earth_position_angle: " << earth_position_angle );
|
|
|
|
FG_LOG(FG_FLIGHT,FG_INFO,"runway_altitude: " << runway_altitude );
|
|
|
|
FG_LOG(FG_FLIGHT,FG_INFO,"runway_latitude: " << runway_latitude );
|
|
|
|
FG_LOG(FG_FLIGHT,FG_INFO,"runway_longitude: " << runway_longitude );
|
|
|
|
FG_LOG(FG_FLIGHT,FG_INFO,"runway_heading: " << runway_heading );
|
|
|
|
FG_LOG(FG_FLIGHT,FG_INFO,"radius_to_rwy: " << radius_to_rwy );
|
|
|
|
FG_LOG(FG_FLIGHT,FG_INFO,"climb_rate: " << climb_rate );
|
|
|
|
FG_LOG(FG_FLIGHT,FG_INFO,"sin_lat_geocentric: " << sin_lat_geocentric );
|
|
|
|
FG_LOG(FG_FLIGHT,FG_INFO,"cos_lat_geocentric: " << cos_lat_geocentric );
|
|
|
|
FG_LOG(FG_FLIGHT,FG_INFO,"sin_longitude: " << sin_longitude );
|
|
|
|
FG_LOG(FG_FLIGHT,FG_INFO,"cos_longitude: " << cos_longitude );
|
|
|
|
FG_LOG(FG_FLIGHT,FG_INFO,"sin_latitude: " << sin_latitude );
|
|
|
|
FG_LOG(FG_FLIGHT,FG_INFO,"cos_latitude: " << cos_latitude );
|
|
|
|
FG_LOG(FG_FLIGHT,FG_INFO,"altitude_agl: " << altitude_agl );
|
|
|
|
}
|
|
|
|
|