Paparazzi UAS v7.1_unstable
Paparazzi is a free software Unmanned Aircraft System.
Loading...
Searching...
No Matches
nps_sensors.c
Go to the documentation of this file.
1#include "nps_sensors.h"
2
4
5void nps_sensors_init(double time)
6{
7
8 struct DoubleEulers body_to_imu_eulers =
9 { NPS_BODY_TO_IMU_PHI, NPS_BODY_TO_IMU_THETA, NPS_BODY_TO_IMU_PSI };
10 double_rmat_of_eulers(&sensors.body_to_imu_rmat, &body_to_imu_eulers);
11
12 nps_sensor_gyro_init(&sensors.gyro, time);
13 nps_sensor_accel_init(&sensors.accel, time);
14 nps_sensor_mag_init(&sensors.mag, time);
15 nps_sensor_baro_init(&sensors.baro, time);
16 nps_sensor_gps_init(&sensors.gps, time);
17 nps_sensor_sonar_init(&sensors.sonar, time);
18 nps_sensor_airspeed_init(&sensors.airspeed, time);
20 nps_sensor_aoa_init(&sensors.aoa, time);
21 nps_sensor_sideslip_init(&sensors.sideslip,time);
22}
23
24
25void nps_sensors_run_step(double time)
26{
27 nps_sensor_gyro_run_step(&sensors.gyro, time, &sensors.body_to_imu_rmat);
28 nps_sensor_accel_run_step(&sensors.accel, time, &sensors.body_to_imu_rmat);
29 nps_sensor_mag_run_step(&sensors.mag, time, &sensors.body_to_imu_rmat);
37}
38
39
41{
42 if (sensors.gyro.data_available) {
43 sensors.gyro.data_available = FALSE;
44 return TRUE;
45 }
46 return FALSE;
47}
48
50{
51 if (sensors.mag.data_available) {
52 sensors.mag.data_available = FALSE;
53 return TRUE;
54 }
55 return FALSE;
56}
57
59{
60 if (sensors.baro.data_available) {
61 sensors.baro.data_available = FALSE;
62 return TRUE;
63 }
64 return FALSE;
65}
66
68{
69 if (sensors.gps.data_available) {
70 sensors.gps.data_available = FALSE;
71 return TRUE;
72 }
73 return FALSE;
74}
75
77{
78 if (sensors.sonar.data_available) {
79 sensors.sonar.data_available = FALSE;
80 return TRUE;
81 }
82 return FALSE;
83}
84
86{
87 if (sensors.airspeed.data_available) {
88 sensors.airspeed.data_available = FALSE;
89 return TRUE;
90 }
91 return FALSE;
92}
93
95{
96 if (sensors.temp.data_available) {
97 sensors.temp.data_available = FALSE;
98 return TRUE;
99 }
100 return FALSE;
101}
102
104{
105 if (sensors.aoa.data_available) {
106 sensors.aoa.data_available = FALSE;
107 return TRUE;
108 }
109 return FALSE;
110}
111
113{
114 if (sensors.sideslip.data_available) {
115 sensors.sideslip.data_available = FALSE;
116 return TRUE;
117 }
118 return FALSE;
119}
#define sensors(...)
static void double_rmat_of_eulers(struct DoubleRMat *rm, struct DoubleEulers *e)
void nps_sensor_accel_init(struct NpsSensorAccel *accel, double time)
void nps_sensor_accel_run_step(struct NpsSensorAccel *accel, double time, struct DoubleRMat *body_to_imu)
void nps_sensor_airspeed_init(struct NpsSensorAirspeed *airspeed, double time)
void nps_sensor_airspeed_run_step(struct NpsSensorAirspeed *airspeed, double time)
void nps_sensor_aoa_init(struct NpsSensorAngleOfAttack *aoa, double time)
void nps_sensor_aoa_run_step(struct NpsSensorAngleOfAttack *aoa, double time)
void nps_sensor_baro_init(struct NpsSensorBaro *baro, double time)
void nps_sensor_baro_run_step(struct NpsSensorBaro *baro, double time)
void nps_sensor_gps_init(struct NpsSensorGps *gps, double time)
void nps_sensor_gps_run_step(struct NpsSensorGps *gps, double time)
void nps_sensor_gyro_init(struct NpsSensorGyro *gyro, double time)
void nps_sensor_gyro_run_step(struct NpsSensorGyro *gyro, double time, struct DoubleRMat *body_to_imu)
void nps_sensor_mag_init(struct NpsSensorMag *mag, double time)
void nps_sensor_mag_run_step(struct NpsSensorMag *mag, double time, struct DoubleRMat *body_to_imu)
void nps_sensor_sideslip_run_step(struct NpsSensorSideSlip *sideslip, double time)
void nps_sensor_sideslip_init(struct NpsSensorSideSlip *sideslip, double time)
void nps_sensor_sonar_run_step(struct NpsSensorSonar *sonar, double time)
void nps_sensor_sonar_init(struct NpsSensorSonar *sonar, double time)
void nps_sensor_temperature_init(struct NpsSensorTemperature *temperature, double time)
void nps_sensor_temperature_run_step(struct NpsSensorTemperature *temperature, double time)
void nps_sensors_init(double time)
Definition nps_sensors.c:5
bool nps_sensors_airspeed_available(void)
Definition nps_sensors.c:85
bool nps_sensors_sonar_available(void)
Definition nps_sensors.c:76
bool nps_sensors_mag_available(void)
Definition nps_sensors.c:49
bool nps_sensors_gps_available(void)
Definition nps_sensors.c:67
bool nps_sensors_sideslip_available(void)
bool nps_sensors_aoa_available(void)
bool nps_sensors_baro_available(void)
Definition nps_sensors.c:58
bool nps_sensors_gyro_available(void)
Definition nps_sensors.c:40
void nps_sensors_run_step(double time)
Definition nps_sensors.c:25
bool nps_sensors_temperature_available(void)
Definition nps_sensors.c:94
#define TRUE
Definition std.h:4
#define FALSE
Definition std.h:5