+ // Set initial Euler angles
+ SG_LOG( SG_FLIGHT, SG_INFO, "...initializing Euler angles..." );
+ set_Euler_Angles( fgGetDouble("/sim/presets/roll-deg")
+ * SGD_DEGREES_TO_RADIANS,
+ fgGetDouble("/sim/presets/pitch-deg")
+ * SGD_DEGREES_TO_RADIANS,
+ fgGetDouble("/sim/presets/heading-deg")
+ * SGD_DEGREES_TO_RADIANS );
+
+ SG_LOG( SG_FLIGHT, SG_INFO, "End common FDM init" );
+}
+
+
+/**
+ * Bind getters and setters to properties.
+ *
+ * The bind() method will be invoked after init(). Note that unlike
+ * the usual implementations of FGSubsystem::bind(), this method does
+ * not automatically pick up existing values for the properties at
+ * bind time; instead, all values are set explicitly in the init()
+ * method.
+ */
+void
+FGInterface::bind ()
+{
+ bound = true;
+
+ // Time management (read-only)
+// fgTie("/fdm/time/delta_t", this,
+// &FGInterface::get_delta_t); // read-only
+// fgTie("/fdm/time/elapsed", this,
+// &FGInterface::get_elapsed); // read-only
+// fgTie("/fdm/time/remainder", this,
+// &FGInterface::get_remainder); // read-only
+// fgTie("/fdm/time/multi_loop", this,
+// &FGInterface::get_multi_loop); // read-only
+
+ // Aircraft position
+ fgTie("/position/latitude-deg", this,
+ &FGInterface::get_Latitude_deg,
+ &FGInterface::set_Latitude_deg,
+ false);
+ fgSetArchivable("/position/latitude-deg");
+ fgTie("/position/longitude-deg", this,
+ &FGInterface::get_Longitude_deg,
+ &FGInterface::set_Longitude_deg,
+ false);
+ fgSetArchivable("/position/longitude-deg");
+ fgTie("/position/altitude-ft", this,
+ &FGInterface::get_Altitude,
+ &FGInterface::set_Altitude,
+ false);
+ fgSetArchivable("/position/altitude-ft");
+ fgTie("/position/altitude-agl-ft", this,
+ &FGInterface::get_Altitude_AGL); // read-only
+ fgSetArchivable("/position/ground-elev-ft");
+ fgTie("/position/ground-elev-ft", this,
+ &FGInterface::get_Runway_altitude); // read-only
+ fgSetArchivable("/position/ground-elev-m");
+ fgTie("/position/ground-elev-m", this,
+ &FGInterface::get_Runway_altitude_m); // read-only
+ fgTie("/environment/ground-elevation-m", this,
+ &FGInterface::get_Runway_altitude_m); // read-only
+ fgSetArchivable("/position/sea-level-radius-ft");
+ fgTie("/position/sea-level-radius-ft", this,
+ &FGInterface::get_Sea_level_radius); // read-only
+
+ // Orientation
+ fgTie("/orientation/roll-deg", this,
+ &FGInterface::get_Phi_deg,
+ &FGInterface::set_Phi_deg);
+ fgSetArchivable("/orientation/roll-deg");
+ fgTie("/orientation/pitch-deg", this,
+ &FGInterface::get_Theta_deg,
+ &FGInterface::set_Theta_deg);
+ fgSetArchivable("/orientation/pitch-deg");
+ fgTie("/orientation/heading-deg", this,
+ &FGInterface::get_Psi_deg,
+ &FGInterface::set_Psi_deg);
+ fgSetArchivable("/orientation/heading-deg");
+
+ // Body-axis "euler rates" (rotation speed, but in a funny
+ // representation).
+ fgTie("/orientation/roll-rate-degps", this,
+ &FGInterface::get_Phi_dot_degps);
+ fgTie("/orientation/pitch-rate-degps", this,
+ &FGInterface::get_Theta_dot_degps);
+ fgTie("/orientation/yaw-rate-degps", this,
+ &FGInterface::get_Psi_dot_degps);
+
+ // Ground speed knots
+ fgTie("/velocities/groundspeed-kt", this,
+ &FGInterface::get_V_ground_speed_kt);
+
+ // Calibrated airspeed
+ fgTie("/velocities/airspeed-kt", this,
+ &FGInterface::get_V_calibrated_kts,
+ &FGInterface::set_V_calibrated_kts,
+ false);
+
+ // Mach number
+ fgTie("/velocities/mach", this,
+ &FGInterface::get_Mach_number,
+ &FGInterface::set_Mach_number,
+ false);
+
+ // Local velocities
+// fgTie("/velocities/speed-north-fps", this,
+// &FGInterface::get_V_north,
+// &FGInterface::set_V_north);
+// fgSetArchivable("/velocities/speed-north-fps");
+// fgTie("/velocities/speed-east-fps", this,
+// &FGInterface::get_V_east,
+// &FGInterface::set_V_east);
+// fgSetArchivable("/velocities/speed-east-fps");
+// fgTie("/velocities/speed-down-fps", this,
+// &FGInterface::get_V_down,
+// &FGInterface::set_V_down);
+// fgSetArchivable("/velocities/speed-down-fps");
+ // FIXME: Temporarily read-only, until the
+ // incompatibilities between JSBSim and
+ // LaRCSim are fixed (LaRCSim adds the
+ // earth's rotation to the east velocity).
+ fgTie("/velocities/speed-north-fps", this,
+ &FGInterface::get_V_north);
+ fgTie("/velocities/speed-east-fps", this,
+ &FGInterface::get_V_east);
+ fgTie("/velocities/speed-down-fps", this,
+ &FGInterface::get_V_down);
+
+ // Relative wind
+ // FIXME: temporarily archivable, until
+ // the NED problem is fixed.
+ fgTie("/velocities/uBody-fps", this,
+ &FGInterface::get_uBody,
+ &FGInterface::set_uBody,
+ false);
+ fgSetArchivable("/velocities/uBody-fps");
+ fgTie("/velocities/vBody-fps", this,
+ &FGInterface::get_vBody,
+ &FGInterface::set_vBody,
+ false);
+ fgSetArchivable("/velocities/vBody-fps");
+ fgTie("/velocities/wBody-fps", this,
+ &FGInterface::get_wBody,
+ &FGInterface::set_wBody,
+ false);
+ fgSetArchivable("/velocities/wBody-fps");
+
+ // Climb and slip (read-only)
+ fgTie("/velocities/vertical-speed-fps", this,
+ &FGInterface::get_Climb_Rate,
+ &FGInterface::set_Climb_Rate );
+ fgTie("/velocities/glideslope", this,
+ &FGInterface::get_Gamma_vert_rad,
+ &FGInterface::set_Gamma_vert_rad );
+ fgTie("/orientation/side-slip-rad", this,
+ &FGInterface::get_Beta); // read-only
+ fgTie("/orientation/side-slip-deg", this,
+ &FGInterface::get_Beta_deg); // read-only
+ fgTie("/orientation/alpha-deg", this,
+ &FGInterface::get_Alpha_deg); // read-only
+ fgTie("/accelerations/nlf", this,
+ &FGInterface::get_Nlf); // read-only
+
+ // NED accelerations
+ fgTie("/accelerations/ned/north-accel-fps_sec",
+ this, &FGInterface::get_V_dot_north);
+ fgTie("/accelerations/ned/east-accel-fps_sec",
+ this, &FGInterface::get_V_dot_east);
+ fgTie("/accelerations/ned/down-accel-fps_sec",
+ this, &FGInterface::get_V_dot_down);
+
+ // Pilot accelerations
+ fgTie("/accelerations/pilot/x-accel-fps_sec",
+ this, &FGInterface::get_A_X_pilot);
+ fgTie("/accelerations/pilot/y-accel-fps_sec",
+ this, &FGInterface::get_A_Y_pilot);
+ fgTie("/accelerations/pilot/z-accel-fps_sec",
+ this, &FGInterface::get_A_Z_pilot);
+
+}
+
+
+/**
+ * Unbind any properties bound to this FDM.
+ *
+ * This method allows the FDM to release properties so that a new
+ * FDM can bind them instead.
+ */
+void
+FGInterface::unbind ()
+{
+ bound = false;
+
+ // fgUntie("/fdm/time/delta_t");
+ // fgUntie("/fdm/time/elapsed");
+ // fgUntie("/fdm/time/remainder");
+ // fgUntie("/fdm/time/multi_loop");
+ fgUntie("/position/latitude-deg");
+ fgUntie("/position/longitude-deg");
+ fgUntie("/position/altitude-ft");
+ fgUntie("/position/altitude-agl-ft");
+ fgUntie("/position/ground-elev-ft");
+ fgUntie("/position/ground-elev-m");
+ fgUntie("/environment/ground-elevation-m");
+ fgUntie("/position/sea-level-radius-ft");
+ fgUntie("/orientation/roll-deg");
+ fgUntie("/orientation/pitch-deg");
+ fgUntie("/orientation/heading-deg");
+ fgUntie("/orientation/roll-rate-degps");
+ fgUntie("/orientation/pitch-rate-degps");
+ fgUntie("/orientation/yaw-rate-degps");
+ fgUntie("/orientation/side-slip-rad");
+ fgUntie("/orientation/side-slip-deg");
+ fgUntie("/orientation/alpha-deg");
+ fgUntie("/velocities/airspeed-kt");
+ fgUntie("/velocities/groundspeed-kt");
+ fgUntie("/velocities/mach");
+ fgUntie("/velocities/speed-north-fps");
+ fgUntie("/velocities/speed-east-fps");
+ fgUntie("/velocities/speed-down-fps");
+ fgUntie("/velocities/uBody-fps");
+ fgUntie("/velocities/vBody-fps");
+ fgUntie("/velocities/wBody-fps");
+ fgUntie("/velocities/vertical-speed-fps");
+ fgUntie("/velocities/glideslope");
+ fgUntie("/accelerations/nlf");
+ fgUntie("/accelerations/pilot/x-accel-fps_sec");
+ fgUntie("/accelerations/pilot/y-accel-fps_sec");
+ fgUntie("/accelerations/pilot/z-accel-fps_sec");
+ fgUntie("/accelerations/ned/north-accel-fps_sec");
+ fgUntie("/accelerations/ned/east-accel-fps_sec");
+ fgUntie("/accelerations/ned/down-accel-fps_sec");
+}
+
+/**
+ * Update the state of the FDM (i.e. run the equations of motion).
+ */
+void
+FGInterface::update (double dt)
+{
+ SG_LOG(SG_FLIGHT, SG_ALERT, "dummy update() ... SHOULDN'T BE CALLED!");
+}
+
+
+void FGInterface::_updatePositionM(const SGVec3d& cartPos)
+{
+ cartesian_position_v = cartPos;
+ geodetic_position_v = SGGeod::fromCart(cartesian_position_v);
+ geocentric_position_v = SGGeoc::fromCart(cartesian_position_v);
+ _set_Sea_level_radius( SGGeodesy::SGGeodToSeaLevelRadius(geodetic_position_v)*SG_METER_TO_FEET );
+ _update_ground_elev_at_pos();
+}
+
+
+void FGInterface::_updatePosition(const SGGeod& geod)
+{
+ geodetic_position_v = geod;
+ cartesian_position_v = SGVec3d::fromGeod(geodetic_position_v);
+ geocentric_position_v = SGGeoc::fromCart(cartesian_position_v);
+
+ _set_Sea_level_radius( SGGeodesy::SGGeodToSeaLevelRadius(geodetic_position_v)*SG_METER_TO_FEET );
+ _update_ground_elev_at_pos();
+}
+
+
+void FGInterface::_updatePosition(const SGGeoc& geoc)
+{
+ geocentric_position_v = geoc;
+ cartesian_position_v = SGVec3d::fromGeoc(geocentric_position_v);
+ geodetic_position_v = SGGeod::fromCart(cartesian_position_v);
+
+ _set_Sea_level_radius( SGGeodesy::SGGeodToSeaLevelRadius(geodetic_position_v)*SG_METER_TO_FEET );
+ _update_ground_elev_at_pos();
+}
+
+
+void FGInterface::_updateGeodeticPosition( double lat, double lon, double alt )
+{
+ _updatePosition(SGGeod::fromRadFt(lon, lat, alt));
+}
+
+
+void FGInterface::_updateGeocentricPosition( double lat, double lon,
+ double alt )
+{
+ _updatePosition(SGGeoc::fromRadFt(lon, lat, get_Sea_level_radius() + alt));
+}
+
+void FGInterface::_update_ground_elev_at_pos( void ) {
+ double groundlevel_m = get_groundlevel_m(geodetic_position_v);
+ _set_Runway_altitude( groundlevel_m * SG_METER_TO_FEET );
+}
+
+// Positions
+void FGInterface::set_Latitude(double lat) {
+ geodetic_position_v.setLatitudeRad(lat);
+}
+
+void FGInterface::set_Longitude(double lon) {
+ geodetic_position_v.setLongitudeRad(lon);
+}
+
+void FGInterface::set_Altitude(double alt) {
+ geodetic_position_v.setElevationFt(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;
+}
+
+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;
+}