34#pragma GCC diagnostic push
35#pragma GCC diagnostic ignored "-Wunused-parameter"
39#include <initialization/FGInitialCondition.h>
40#include <models/FGPropulsion.h>
41#include <models/FGGroundReactions.h>
42#include <models/FGAccelerations.h>
43#include <models/FGAuxiliary.h>
44#include <models/FGAtmosphere.h>
45#include <models/FGAircraft.h>
46#include <models/FGFCS.h>
47#include <models/atmosphere/FGWinds.h>
50#include <models/propulsion/FGThruster.h>
51#include <models/propulsion/FGPropeller.h>
54#pragma GCC diagnostic pop
66#include "generated/airframe.h"
67#include "generated/flight_plan.h"
70#define MetersOfFeet(_f) ((_f)/3.2808399)
71#define FeetOfMeters(_m) ((_m)*3.2808399)
73#define PascalOfPsf(_p) ((_p) * 47.8802588889)
74#define CelsiusOfRankine(_r) (((_r) - 491.67) / 1.8)
77#if NPS_JSBSIM_USE_SGPATH
78#define JSBSIM_PATH(_x) SGPath(_x)
80#define JSBSIM_PATH(_x) _x
84#ifdef NPS_USE_COMMANDS
85#define NPS_AUTOMATIC_JSBSIM_ACTUATOR_NAMES TRUE
88#ifdef NPS_ACTUATOR_NAMES
89#define NPS_AUTOMATIC_JSBSIM_ACTUATOR_NAMES TRUE
92#ifndef NPS_AUTOMATIC_JSBSIM_ACTUATOR_NAMES
93#define NPS_AUTOMATIC_JSBSIM_ACTUATOR_NAMES FALSE
99#ifndef NPS_JSBSIM_MODEL
100#define NPS_JSBSIM_MODEL AIRFRAME_NAME
103#ifdef NPS_INITIAL_CONDITITONS
104#warning NPS_INITIAL_CONDITITONS was replaced by NPS_JSBSIM_INIT!
105#warning Defaulting to flight plan location.
111#ifndef NPS_JSBSIM_PITCH_TRIM
112#define NPS_JSBSIM_PITCH_TRIM 0.0
115#ifndef NPS_JSBSIM_ROLL_TRIM
116#define NPS_JSBSIM_ROLL_TRIM 0.0
119#ifndef NPS_JSBSIM_YAW_TRIM
120#define NPS_JSBSIM_YAW_TRIM 0.0
128#ifndef NPS_JSBSIM_ELEVATOR_MAX_RAD
129#define NPS_JSBSIM_ELEVATOR_MAX_RAD (20.0*DEG2RAD)
132#ifndef NPS_JSBSIM_AILERON_MAX_RAD
133#define NPS_JSBSIM_AILERON_MAX_RAD (20.0*DEG2RAD)
136#ifndef NPS_JSBSIM_RUDDER_MAX_RAD
137#define NPS_JSBSIM_RUDDER_MAX_RAD (20.0*DEG2RAD)
140#ifndef NPS_JSBSIM_FLAP_MAX_RAD
141#define NPS_JSBSIM_FLAP_MAX_RAD (20.0*DEG2RAD)
147#define MIN_DT (1.0/10240.0)
151using namespace JSBSim;
210 printf(
"fdm.time,fdm.body_ecef_accel.x,fdm.body_ecef_accel.y,fdm.body_ecef_accel.z,fdm.ltp_ecef_accel.x,fdm.ltp_ecef_accel.y,fdm.ltp_ecef_accel.z,fdm.ecef_ecef_accel.x,fdm.ecef_ecef_accel.y,fdm.ecef_ecef_accel.z,fdm.ltpprz_ecef_accel.z,fdm.ltpprz_ecef_accel.y,fdm.ltpprz_ecef_accel.z,fdm.agl\n");
225#ifdef NPS_JSBSIM_LAUNCHSPEED
226 static bool already_launched =
FALSE;
228 if (launch && !already_launched) {
229 printf(
"Launching with speed of %.1f m/s!\n", (
float)NPS_JSBSIM_LAUNCHSPEED);
232#ifdef NPS_JSBSIM_LAUNCH_RPM
235 FGPropulsion *propulsion =
FDMExec->GetPropulsion();
236 for (
uint32_t i = 0; i < propulsion->GetNumEngines(); i++) {
237 FGThruster *thruster = propulsion->GetEngine(i)->GetThruster();
238 if (thruster->GetRPM() < NPS_JSBSIM_LAUNCH_RPM) {
239 thruster->SetRPM(NPS_JSBSIM_LAUNCH_RPM);
243 already_launched =
TRUE;
266 if (
fdm.ltp_ecef_vel.z > 0) {
270 if (numDT_to_impact <= 1.0) {
276 fdm.curr_dt =
fdm.init_dt;
280 int num_steps = int(
fdm.init_dt /
fdm.curr_dt);
285 for (i = 0; i < num_steps; i++) {
293 printf(
"Error: FDM simulation encountered a total of %i NaN values at simulation time %f.\n",
fdm.nan_count,
fdm.time);
294 printf(
"It is likely the simulation diverged and gave non-physical results. If you did\n");
295 printf(
"not crash, check your model and/or initial conditions. Exiting with status 1.\n");
303 FGWinds *Winds =
FDMExec->GetWinds();
305 Winds->SetWindPsi(
dir);
310 FGWinds *Winds =
FDMExec->GetWinds();
317 FGWinds *Winds =
FDMExec->GetWinds();
320 Winds->SetProbabilityOfExceedence(turbulence_severity);
325 FDMExec->GetAtmosphere()->SetTemperature(temp,
h, FGAtmosphere::eCelsius);
336#if NPS_AUTOMATIC_JSBSIM_ACTUATOR_NAMES
338#if defined(NPS_USE_COMMANDS)
339 const char *names[] = COMMAND_NAMES;
340#elif defined(NPS_ACTUATOR_NAMES)
341 const char *names[] = NPS_ACTUATOR_NAMES;
345 for (i = 0; i < commands_nb; i++) {
346 sprintf(buf,
"fcs/%s", names[i]);
347 property = string(buf);
348 FDMExec->GetPropertyManager()->GetNode(property)->SetDouble(
"",
commands[i]);
352 FGFCS *FCS =
FDMExec->GetFCS();
359#ifdef COMMAND_THROTTLE
360 FGPropulsion *FProp =
FDMExec->GetPropulsion();
361 for (
unsigned int i = 0; i <
FDMExec->GetPropulsion()->GetNumEngines(); i++) {
362 FCS->SetThrottleCmd(i,
commands[COMMAND_THROTTLE]);
365 if (
commands[COMMAND_THROTTLE] > 0.01) {
366 FProp->SetStarter(1);
368 FProp->SetStarter(0);
382 FCS->SetDrCmd(
commands[COMMAND_YAW]);
386 FCS->SetDfCmd(
commands[COMMAND_FLAP]);
398 fdm.time =
FDMExec->GetPropertyManager()->GetNode(
"simulation/sim-time-sec")->getDoubleValue();
401 printf(
"%f,",
fdm.time);
404 FGPropagate *propagate =
FDMExec->GetPropagate();
405 FGAccelerations *accelerations =
FDMExec->GetAccelerations();
407 fdm.on_ground =
FDMExec->GetGroundReactions()->GetWOW();
413 fdm.hmsl = propagate->GetAltitudeASLmeters();
426 printf(
"%f,%f,%f,",
fdm.body_ecef_accel.x,
fdm.body_ecef_accel.y,
fdm.body_ecef_accel.z);
431 const FGColumnVector3 &fg_ltp_ecef_accel = propagate->GetTb2l() * accelerations->GetUVWdot();
435 printf(
"%f,%f,%f,",
fdm.ltp_ecef_accel.x,
fdm.ltp_ecef_accel.y,
fdm.ltp_ecef_accel.z);
439 const FGColumnVector3 &fg_ecef_ecef_vel = propagate->GetECEFVelocity();
442 const FGColumnVector3 &fg_ecef_ecef_accel = propagate->GetTb2ec() * accelerations->GetUVWdot();
446 printf(
"%f,%f,%f,",
fdm.ecef_ecef_accel.x,
fdm.ecef_ecef_accel.y,
fdm.ecef_ecef_accel.z);
455 printf(
"%f,%f,%f,",
fdm.ltpprz_ecef_accel.z,
fdm.ltpprz_ecef_accel.y,
fdm.ltpprz_ecef_accel.z);
468 printf(
"%f\n",
fdm.agl);
474 const FGQuaternion jsb_quat = propagate->GetQuaternion();
496 const FGColumnVector3 &fg_wind_ned =
FDMExec->GetWinds()->GetTotalWindNED();
512 fdm.aoa=
FDMExec->GetPropertyManager()->GetNode(
"aero/alpha-rad")->getDoubleValue();
513 fdm.sideslip =
FDMExec->GetPropertyManager()->GetNode(
"aero/beta-rad")->getDoubleValue();
519 fdm.rudder = (
FDMExec->GetPropertyManager()->GetNode(
"fcs/rudder-pos-rad")->getDoubleValue()) /
521 fdm.left_aileron = (-1 *
FDMExec->GetPropertyManager()->GetNode(
"fcs/left-aileron-pos-rad")->getDoubleValue()) /
523 fdm.right_aileron = (
FDMExec->GetPropertyManager()->GetNode(
"fcs/right-aileron-pos-rad")->getDoubleValue()) /
525 fdm.elevator = (
FDMExec->GetPropertyManager()->GetNode(
"fcs/elevator-pos-rad")->getDoubleValue()) /
532 FGPropulsion *FGProp =
FDMExec->GetPropulsion();
533 fdm.num_engines = FGProp->GetNumEngines();
541 FGEngine *FGEng = FGProp->GetEngine(k);
542 FGThruster *FGThrst = FGEng->GetThruster();
543 fdm.eng_state[k] = FGEng->GetStarter();
544 fdm.rpm[k] = (float) FGThrst->GetRPM();
565 string jsbsim_home =
"/conf/simulator/jsbsim/";
566 string jsbsim_ic_name;
568 char* pprz_home = getenv(
"PAPARAZZI_HOME");
571 if (strlen(pprz_home) <
sizeof(buf)) {
572 cnt = snprintf(buf, strlen(pprz_home) + 1,
"%s", pprz_home);
573 rootdir = string(buf) + jsbsim_home;
580 cout <<
"PPRZ_HOME not set correctly, exiting..." << endl;
587#ifdef NPS_JSBSIM_INIT
588 jsbsim_ic_name = NPS_JSBSIM_INIT;
605 cerr <<
" JSBSim could not be started" << endl << endl;
613 cerr <<
"NumEngines: " <<
FDMExec->GetPropulsion()->GetNumEngines() << endl;
614 cerr <<
"NumGearUnits: " <<
FDMExec->GetGroundReactions()->GetNumGearUnits() << endl;
620 FGInitialCondition *IC =
FDMExec->GetIC();
621 if (!jsbsim_ic_name.empty()) {
624 cerr <<
"Initialization unsuccessful" << endl;
631 cout <<
"JSBSim initial conditions loaded from " << jsbsim_ic_name << endl;
636 IC->SetVgroundFpsIC(0.);
640 double gd_lat = RadOfDeg(NAV_LAT0 / 1e7);
642 IC->SetLatitudeDegIC(DegOfRad(gc_lat));
643 IC->SetLongitudeDegIC(NAV_LON0 / 1e7);
645 IC->SetWindNEDFpsIC(0.0, 0.0, 0.0);
648 IC->SetPsiDegIC(QFU);
649 IC->SetVgroundFpsIC(0.);
651 lla0.
lon = RadOfDeg(NAV_LON0 / 1e7);
653 lla0.
alt = (double)(NAV_ALT0 + NAV_MSL0) / 1000.0;
662 cerr <<
"Initialization unsuccessful" << endl;
667 FDMExec->GetPropulsion()->InitRunning(-1);
681 int num_gear =
FDMExec->GetGroundReactions()->GetNumGearUnits();
683 for (i = 0; i < num_gear; i++) {
684 FGColumnVector3 gear_location =
FDMExec->GetGroundReactions()->GetGearUnit(i)->GetBodyLocation();
685 double radius =
MetersOfFeet(gear_location.Magnitude());
698 FGPropagate *propagate =
FDMExec->GetPropagate();
708#if !NPS_CALC_GEO_MAG && defined(AHRS_H_X)
709 PRINT_CONFIG_MSG(
"Using magnetic field as defined in airframe file (AHRS section).")
710 fdm.ltp_h.x = AHRS_H_X;
711 fdm.ltp_h.y = AHRS_H_Y;
712 fdm.ltp_h.z = AHRS_H_Z;
713#elif !NPS_CALC_GEO_MAG && defined(INS_H_X)
714 PRINT_CONFIG_MSG(
"Using magnetic field as defined in airframe file (INS section).")
715 fdm.ltp_h.x = INS_H_X;
716 fdm.ltp_h.y = INS_H_Y;
717 fdm.ltp_h.z = INS_H_Z;
719 PRINT_CONFIG_MSG(
"Using WMM2010 model to calculate magnetic field at simulated location.")
725 double sdate = 2019.0;
729 double latitude = DegOfRad(
fdm.lla_pos.lat);
730 double longitude = DegOfRad(
fdm.lla_pos.lon);
731 double alt =
fdm.lla_pos.alt / 1e3;
736 mag_calc(1, latitude, longitude, alt, nmax, gha,
737 &
fdm.ltp_h.x, &
fdm.ltp_h.y, &
fdm.ltp_h.z,
740 printf(
"normalized magnetic field: %.4f %.4f %.4f\n",
fdm.ltp_h.x,
fdm.ltp_h.y,
fdm.ltp_h.z);
789 fdm_quat->
qi = jsb_quat->Entry(1);
790 fdm_quat->
qx = jsb_quat->Entry(2);
791 fdm_quat->
qy = jsb_quat->Entry(3);
792 fdm_quat->
qz = jsb_quat->Entry(4);
805 fdm_rate->
p = jsb_vector->Entry(1);
806 fdm_rate->
q = jsb_vector->Entry(2);
807 fdm_rate->
r = jsb_vector->Entry(3);
822 fdm_lla->
lat = propagate->GetGeodLatitudeRad();
823 fdm_lla->
lon = propagate->GetLongitude();
824 fdm_lla->
alt = propagate->GetAltitudeASLmeters();
842 fdm_lla->
lat = propagate->GetLatitude();
843 fdm_lla->
lon = propagate->GetLongitude();
859 fdm_lla->
lat = propagate->GetGeodLatitudeRad();
860 fdm_lla->
lon = propagate->GetLongitude();
868static int isnan(
double f) {
return (
f !=
f); }
880 int orig_nan_count =
fdm.nan_count;
882 if (isnan(
fdm.ecef_pos.x)) {
fdm.nan_count++; }
883 if (isnan(
fdm.ecef_pos.y)) {
fdm.nan_count++; }
884 if (isnan(
fdm.ecef_pos.z)) {
fdm.nan_count++; }
885 if (isnan(
fdm.ltpprz_pos.x)) {
fdm.nan_count++; }
886 if (isnan(
fdm.ltpprz_pos.y)) {
fdm.nan_count++; }
887 if (isnan(
fdm.ltpprz_pos.z)) {
fdm.nan_count++; }
888 if (isnan(
fdm.lla_pos.lon)) {
fdm.nan_count++; }
889 if (isnan(
fdm.lla_pos.lat)) {
fdm.nan_count++; }
890 if (isnan(
fdm.lla_pos.alt)) {
fdm.nan_count++; }
891 if (isnan(
fdm.hmsl)) {
fdm.nan_count++; }
893 if (isnan(
fdm.ecef_ecef_vel.x)) {
fdm.nan_count++; }
894 if (isnan(
fdm.ecef_ecef_vel.y)) {
fdm.nan_count++; }
895 if (isnan(
fdm.ecef_ecef_vel.z)) {
fdm.nan_count++; }
896 if (isnan(
fdm.ecef_ecef_accel.x)) {
fdm.nan_count++; }
897 if (isnan(
fdm.ecef_ecef_accel.y)) {
fdm.nan_count++; }
898 if (isnan(
fdm.ecef_ecef_accel.z)) {
fdm.nan_count++; }
899 if (isnan(
fdm.body_ecef_vel.x)) {
fdm.nan_count++; }
900 if (isnan(
fdm.body_ecef_vel.y)) {
fdm.nan_count++; }
901 if (isnan(
fdm.body_ecef_vel.z)) {
fdm.nan_count++; }
902 if (isnan(
fdm.body_ecef_accel.x)) {
fdm.nan_count++; }
903 if (isnan(
fdm.body_ecef_accel.y)) {
fdm.nan_count++; }
904 if (isnan(
fdm.body_ecef_accel.z)) {
fdm.nan_count++; }
905 if (isnan(
fdm.ltp_ecef_vel.x)) {
fdm.nan_count++; }
906 if (isnan(
fdm.ltp_ecef_vel.y)) {
fdm.nan_count++; }
907 if (isnan(
fdm.ltp_ecef_vel.z)) {
fdm.nan_count++; }
908 if (isnan(
fdm.ltp_ecef_accel.x)) {
fdm.nan_count++; }
909 if (isnan(
fdm.ltp_ecef_accel.y)) {
fdm.nan_count++; }
910 if (isnan(
fdm.ltp_ecef_accel.z)) {
fdm.nan_count++; }
911 if (isnan(
fdm.ltpprz_ecef_vel.x)) {
fdm.nan_count++; }
912 if (isnan(
fdm.ltpprz_ecef_vel.y)) {
fdm.nan_count++; }
913 if (isnan(
fdm.ltpprz_ecef_vel.z)) {
fdm.nan_count++; }
914 if (isnan(
fdm.ltpprz_ecef_accel.x)) {
fdm.nan_count++; }
915 if (isnan(
fdm.ltpprz_ecef_accel.y)) {
fdm.nan_count++; }
916 if (isnan(
fdm.ltpprz_ecef_accel.z)) {
fdm.nan_count++; }
917 if (isnan(
fdm.ecef_to_body_quat.qi)) {
fdm.nan_count++; }
918 if (isnan(
fdm.ecef_to_body_quat.qx)) {
fdm.nan_count++; }
919 if (isnan(
fdm.ecef_to_body_quat.qy)) {
fdm.nan_count++; }
920 if (isnan(
fdm.ecef_to_body_quat.qz)) {
fdm.nan_count++; }
921 if (isnan(
fdm.ltp_to_body_quat.qi)) {
fdm.nan_count++; }
922 if (isnan(
fdm.ltp_to_body_quat.qx)) {
fdm.nan_count++; }
923 if (isnan(
fdm.ltp_to_body_quat.qy)) {
fdm.nan_count++; }
924 if (isnan(
fdm.ltp_to_body_quat.qz)) {
fdm.nan_count++; }
925 if (isnan(
fdm.ltp_to_body_eulers.phi)) {
fdm.nan_count++; }
926 if (isnan(
fdm.ltp_to_body_eulers.theta)) {
fdm.nan_count++; }
927 if (isnan(
fdm.ltp_to_body_eulers.psi)) {
fdm.nan_count++; }
928 if (isnan(
fdm.ltpprz_to_body_quat.qi)) {
fdm.nan_count++; }
929 if (isnan(
fdm.ltpprz_to_body_quat.qx)) {
fdm.nan_count++; }
930 if (isnan(
fdm.ltpprz_to_body_quat.qy)) {
fdm.nan_count++; }
931 if (isnan(
fdm.ltpprz_to_body_quat.qz)) {
fdm.nan_count++; }
932 if (isnan(
fdm.ltpprz_to_body_eulers.phi)) {
fdm.nan_count++; }
933 if (isnan(
fdm.ltpprz_to_body_eulers.theta)) {
fdm.nan_count++; }
934 if (isnan(
fdm.ltpprz_to_body_eulers.psi)) {
fdm.nan_count++; }
935 if (isnan(
fdm.body_ecef_rotvel.p)) {
fdm.nan_count++; }
936 if (isnan(
fdm.body_ecef_rotvel.q)) {
fdm.nan_count++; }
937 if (isnan(
fdm.body_ecef_rotvel.r)) {
fdm.nan_count++; }
938 if (isnan(
fdm.body_ecef_rotaccel.p)) {
fdm.nan_count++; }
939 if (isnan(
fdm.body_ecef_rotaccel.q)) {
fdm.nan_count++; }
940 if (isnan(
fdm.body_ecef_rotaccel.r)) {
fdm.nan_count++; }
941 if (isnan(
fdm.ltp_g.x)) {
fdm.nan_count++; }
942 if (isnan(
fdm.ltp_g.y)) {
fdm.nan_count++; }
943 if (isnan(
fdm.ltp_g.z)) {
fdm.nan_count++; }
944 if (isnan(
fdm.ltp_h.x)) {
fdm.nan_count++; }
945 if (isnan(
fdm.ltp_h.y)) {
fdm.nan_count++; }
946 if (isnan(
fdm.ltp_h.z)) {
fdm.nan_count++; }
948 return (
fdm.nan_count - orig_nan_count);
static void h(const real32_T x[7], const real32_T q[4], real32_T y[6])
void double_eulers_of_quat(struct DoubleEulers *e, struct DoubleQuat *q)
static void double_vect3_normalize(struct DoubleVect3 *v)
normalize 3D vector in place
#define EULERS_COPY(_a, _b)
#define VECT3_ASSIGN(_a, _x, _y, _z)
#define QUAT_COPY(_qo, _qi)
#define VECT3_DIFF(_c, _a, _b)
#define VECT3_ADD(_a, _b)
double alt
in meters above WGS84 reference ellipsoid
double gc_of_gd_lat_d(double gd_lat, double hmsl)
void ltp_def_from_ecef_d(struct LtpDef_d *def, struct EcefCoor_d *ecef)
void ned_of_ecef_vect_d(struct NedCoor_d *ned, struct LtpDef_d *def, struct EcefCoor_d *ecef)
void lla_of_ecef_d(struct LlaCoor_d *lla, struct EcefCoor_d *ecef)
void ned_of_ecef_point_d(struct NedCoor_d *ned, struct LtpDef_d *def, struct EcefCoor_d *ecef)
void ecef_of_lla_d(struct EcefCoor_d *ecef, struct LlaCoor_d *lla)
vector in EarthCenteredEarthFixed coordinates
vector in Latitude, Longitude and Altitude
definition of the local (flat earth) coordinate system
int16_t mag_calc(int16_t igdgc, double flat, double flon, double elev, int16_t nmax, double *gh, double *geo_mag_x, double *geo_mag_y, double *geo_mag_z, int16_t iext, double ext1, double ext2, double ext3)
int16_t extrapsh(double date, double dte1, int16_t nmax1, int16_t nmax2, double *gh)
PRINT_CONFIG_MSG("USE_INS_NAV_INIT defaulting to TRUE")
#define NPS_COMMANDS_NB
Number of commands sent to the FDM of NPS.
struct NpsFdm fdm
Holds all necessary NPS FDM state information.
static struct LtpDef_d ltpdef
#define CelsiusOfRankine(_r)
void nps_fdm_set_wind_ned(double wind_north, double wind_east, double wind_down)
#define NPS_JSBSIM_RUDDER_MAX_RAD
double vehicle_radius_max
The largest distance between vehicle CG and contact point.
#define NPS_JSBSIM_PITCH_TRIM
Trim values for the airframe.
#define NPS_JSBSIM_MODEL
Name of the JSBSim model.
static FGFDMExec * FDMExec
The JSBSim executive object.
void nps_fdm_init(double dt)
NPS FDM rover init.
static void init_jsbsim(double dt)
Initializes JSBSim.
static void fetch_state(void)
Populates the NPS fdm struct after a simulation step.
static void lla_from_jsbsim_geodetic(LlaCoor_d *fdm_lla, FGPropagate *propagate)
Convert JSBSim location to NPS LLA.
static void init_ltp(void)
Initialize the ltp from the JSBSim location.
#define MIN_DT
Minimum JSBSim timestep Around 1/10000 seems to be good for ground impacts.
void nps_fdm_run_step(bool launch, double *commands, int commands_nb)
Minimum complexity flight dynamic model In legacy Paparazzi simulator, was implemented in OCaml and c...
static void jsbsimloc_to_loc(EcefCoor_d *fdm_location, const FGLocation *jsb_location)
Convert JSBSim location format and struct to NPS location format and struct.
#define NPS_JSBSIM_ELEVATOR_MAX_RAD
#define NPS_JSBSIM_FLAP_MAX_RAD
void nps_fdm_set_temperature(double temp, double h)
Set temperature in degrees Celcius at given height h above MSL.
static void jsbsimquat_to_quat(DoubleQuat *fdm_quat, const FGQuaternion *jsb_quat)
Convert JSBSim quaternion struct to NPS quaternion struct.
static void lla_from_jsbsim_geocentric(LlaCoor_d *fdm_lla, FGPropagate *propagate)
Convert JSBSim location to NPS LLA.
#define NPS_JSBSIM_YAW_TRIM
static int check_for_nan(void)
Checks NpsFdm struct for NaNs.
#define JSBSIM_PATH(_x)
Macro to build file path according to the lib version.
void nps_fdm_set_turbulence(double wind_speed, int turbulence_severity)
static void feed_jsbsim(double *commands, int commands_nb)
Feed JSBSim with the latest actuator commands.
static void jsbsimvec_to_vec(DoubleVect3 *fdm_vector, const FGColumnVector3 *jsb_vector)
Convert JSBSim vector format and struct to NPS vector format and struct.
static void jsbsimvec_to_rate(DoubleRates *fdm_rate, const FGColumnVector3 *jsb_vector)
Convert JSBSim rates vector struct to NPS rates struct.
#define NPS_JSBSIM_AILERON_MAX_RAD
void nps_fdm_set_wind(double speed, double dir)
void nps_fdm_run_init_step(void)
double min_dt
Timestep used for higher fidelity near the ground.
#define MetersOfFeet(_f)
Macro to convert from feet to metres.
static void llh_from_jsbsim(LlaCoor_d *fdm_lla, FGPropagate *propagate)
Convert JSBSim location to NPS LLH.
#define NPS_JSBSIM_ROLL_TRIM
Paparazzi generic algebra macros.
Paparazzi floating point algebra.
Paparazzi generic macros for geodetic calculations.
Paparazzi double-precision floating point math for geodetic calculations.
Paparazzi floating point math for geodetic calculations.
static const ShellCommand commands[]
static const float offset[]
unsigned short uint16_t
Typedef defining 16 bit unsigned short type.
int int32_t
Typedef defining 32 bit int type.
unsigned int uint32_t
Typedef defining 32 bit unsigned int type.
uint16_t f
Camera baseline, in meters (i.e. horizontal distance between the two cameras of the stereo setup).