Paparazzi UAS
v5.12_stable-4-g9b43e9b
Paparazzi is a free software Unmanned Aircraft System.
|
#include "std.h"
#include "../flight_gear.h"
#include "math/pprz_geodetic_double.h"
#include "math/pprz_algebra_double.h"
Go to the source code of this file.
Data Structures | |
struct | NpsFdm |
Functions | |
void | nps_fdm_init (double dt) |
Set JSBsim specific fields that are not used for Gazebo. More... | |
void | nps_fdm_run_step (bool launch, double *commands, int commands_nb) |
Update the simulation state. More... | |
void | nps_fdm_set_wind (double speed, double dir) |
void | nps_fdm_set_wind_ned (double wind_north, double wind_east, double wind_down) |
void | nps_fdm_set_turbulence (double wind_speed, int turbulence_severity) |
void | nps_fdm_set_temperature (double temp, double h) |
Set temperature in degrees Celcius at given height h above MSL. More... | |
Variables | |
struct NpsFdm | fdm |
Holds all necessary NPS FDM state information. More... | |
struct NpsFdm |
Data Fields | ||
---|---|---|
double | agl | |
double | airspeed | equivalent airspeed in m/s |
double | aoa | angle of attack in rad |
struct DoubleVect3 | body_accel |
acceleration in body frame as measured by an accelerometer (incl. gravity) |
struct DoubleVect3 | body_ecef_accel | acceleration in body frame, wrt ECEF frame |
struct DoubleRates | body_ecef_rotaccel | |
struct DoubleRates | body_ecef_rotvel | |
struct DoubleVect3 | body_ecef_vel | velocity in body frame, wrt ECEF frame |
struct DoubleVect3 | body_inertial_accel | acceleration in body frame, wrt ECI inertial frame |
struct DoubleRates | body_inertial_rotaccel | |
struct DoubleRates | body_inertial_rotvel | |
double | curr_dt | |
double | dynamic_pressure | dynamic pressure in Pascal |
struct EcefCoor_d | ecef_ecef_accel | acceleration in ECEF frame, wrt ECEF frame |
struct EcefCoor_d | ecef_ecef_vel | velocity in ECEF frame, wrt ECEF frame |
struct EcefCoor_d | ecef_pos | |
struct DoubleQuat | ecef_to_body_quat | |
float | elevator | |
uint32_t | eng_state[FG_NET_FDM_MAX_ENGINES] | |
float | flap | |
double | hmsl | |
double | init_dt | |
float | left_aileron | |
struct LlaCoor_d | lla_pos | |
struct LlaCoor_d | lla_pos_geoc | |
struct LlaCoor_d | lla_pos_geod | |
struct LlaCoor_d | lla_pos_pprz | |
struct NedCoor_d | ltp_ecef_accel | acceleration in LTP frame, wrt ECEF frame |
struct NedCoor_d | ltp_ecef_vel | velocity in LTP frame, wrt ECEF frame |
struct DoubleVect3 | ltp_g | |
struct DoubleVect3 | ltp_h | |
struct DoubleEulers | ltp_to_body_eulers | |
struct DoubleQuat | ltp_to_body_quat | |
struct NedCoor_d | ltpprz_ecef_accel | accel in ltppprz frame, wrt ECEF frame |
struct NedCoor_d | ltpprz_ecef_vel | velocity in ltppprz frame, wrt ECEF frame |
struct NedCoor_d | ltpprz_pos | |
struct DoubleEulers | ltpprz_to_body_eulers | |
struct DoubleQuat | ltpprz_to_body_quat | |
int | nan_count | |
uint32_t | num_engines | |
bool | on_ground | |
double | pressure | current (static) atmospheric pressure in Pascal |
double | pressure_sl | pressure at sea level in Pascal |
float | right_aileron | |
float | rpm[FG_NET_FDM_MAX_ENGINES] | |
float | rudder | |
double | sideslip | sideslip angle in rad |
double | temperature | current temperature in degrees Celcius |
double | time | |
double | total_pressure | total atmospheric pressure in Pascal |
struct DoubleVect3 | wind | velocity in m/s in NED |
void nps_fdm_init | ( | double | dt | ) |
Set JSBsim specific fields that are not used for Gazebo.
dt |
Definition at line 119 of file nps_fdm_crrcsim.c.
References _crrcsim::buf, crrcsim, NpsFdm::curr_dt, NpsFdm::dynamic_pressure, fdm, FDMExec, fetch_state(), NpsFdm::init_dt, init_jsbsim(), init_ltp(), inputbuf_init(), MIN_DT, min_dt, NpsFdm::nan_count, NPS_CRRCSIM_HOST_IP, NPS_CRRCSIM_HOST_PORT, offset, open_udp(), PPRZ_ISA_SEA_LEVEL_PRESSURE, NpsFdm::pressure, NpsFdm::pressure_sl, send_servo_cmd(), _crrcsim::socket, NpsFdm::temperature, NpsFdm::total_pressure, UDP_NONBLOCKING, and VECT3_ASSIGN.
Referenced by nps_main_init().
void nps_fdm_run_step | ( | bool | launch, |
double * | commands, | ||
int | commands_nb | ||
) |
Update the simulation state.
launch | |
commands | |
commands_nb |
Definition at line 150 of file nps_fdm_crrcsim.c.
References NpsFdm::agl, check_for_nan(), crrcsim, NpsFdm::curr_dt, _crrcsim::data_buffer, decode_ahrspacket(), decode_gpspacket(), decode_imupacket(), FALSE, fdm, FDMExec, feed_jsbsim(), FeetOfMeters, fetch_state(), gazebo_initialized, gazebo_read(), gazebo_write(), get_msg(), NpsFdm::init_dt, init_gazebo(), NpsFdm::ltp_ecef_vel, min_dt, model, NpsFdm::nan_count, send_servo_cmd(), NpsFdm::time, TRUE, vehicle_radius_max, and NedCoor_d::z.
Referenced by nps_main_run_sim_step().
void nps_fdm_set_temperature | ( | double | temp, |
double | h | ||
) |
Set temperature in degrees Celcius at given height h above MSL.
Definition at line 233 of file nps_fdm_gazebo.cpp.
References FDMExec.
void nps_fdm_set_turbulence | ( | double | wind_speed, |
int | turbulence_severity | ||
) |
Definition at line 211 of file nps_fdm_crrcsim.c.
References FDMExec, and FeetOfMeters.
Referenced by nps_atmosphere_update().
void nps_fdm_set_wind | ( | double | speed, |
double | dir | ||
) |
Definition at line 200 of file nps_fdm_crrcsim.c.
References FDMExec, and FeetOfMeters.
void nps_fdm_set_wind_ned | ( | double | wind_north, |
double | wind_east, | ||
double | wind_down | ||
) |
Definition at line 205 of file nps_fdm_crrcsim.c.
References FDMExec, and FeetOfMeters.
Referenced by nps_atmosphere_update().
struct NpsFdm fdm |
Holds all necessary NPS FDM state information.
Definition at line 84 of file nps_fdm_crrcsim.c.
Referenced by check_for_nan(), fetch_state(), gazebo_read(), gps_feed_value(), init_ltp(), nps_fdm_init(), nps_fdm_run_step(), nps_flightgear_send(), nps_flightgear_send_fdm(), nps_ins_data_loop(), nps_ivy_send_WORLD_ENV_REQ(), nps_main_display(), nps_main_loop(), nps_sensor_accel_run_step(), nps_sensor_airspeed_run_step(), nps_sensor_aoa_run_step(), nps_sensor_baro_run_step(), nps_sensor_gps_run_step(), nps_sensor_gyro_run_step(), nps_sensor_mag_run_step(), nps_sensor_sideslip_run_step(), nps_sensor_sonar_run_step(), nps_sensor_temperature_run_step(), sim_overwrite_ahrs(), and sim_overwrite_ins().