Paparazzi UAS
v7.0_unstable
Paparazzi is a free software Unmanned Aircraft System.
|
Vertical guidance for rotorcrafts. More...
#include "std.h"
#include "firmwares/rotorcraft/guidance/guidance_v_ref.h"
#include "firmwares/rotorcraft/guidance/guidance_v_adapt.h"
#include "firmwares/rotorcraft/stabilization.h"
Go to the source code of this file.
Data Structures | |
struct | VerticalGuidance |
Macros | |
#define | GUIDANCE_V_MODE_KILL 0 |
#define | GUIDANCE_V_MODE_RC_DIRECT 1 |
#define | GUIDANCE_V_MODE_RC_CLIMB 2 |
#define | GUIDANCE_V_MODE_CLIMB 3 |
#define | GUIDANCE_V_MODE_HOVER 4 |
#define | GUIDANCE_V_MODE_NAV 5 |
#define | GUIDANCE_V_MODE_GUIDED 6 |
#define | GuidanceVSetRef guidance_v_set_ref |
Functions | |
void | guidance_v_init (void) |
void | guidance_v_mode_changed (uint8_t new_mode) |
void | guidance_v_notify_in_flight (bool in_flight) |
void | guidance_v_thrust_adapt (bool in_flight) |
void | guidance_v_update_ref (void) |
void | guidance_v_z_enter (void) |
void | guidance_v_run_enter (void) |
struct ThrustSetpoint | guidance_v_run (bool in_flight) |
Guidance vertical run functions. More... | |
struct ThrustSetpoint | guidance_v_run_pos (bool in_flight, struct VerticalGuidance *gv) |
struct ThrustSetpoint | guidance_v_run_speed (bool in_flight, struct VerticalGuidance *gv) |
struct ThrustSetpoint | guidance_v_run_accel (bool in_flight, struct VerticalGuidance *gv) |
void | guidance_v_set_ref (int32_t pos, int32_t speed, int32_t accel) |
Set guidance ref parameters. More... | |
struct ThrustSetpoint | guidance_v_from_nav (bool in_flight) |
Set guidance setpoint from NAV and run hover loop. More... | |
void | guidance_v_guided_enter (void) |
Enter GUIDED mode control. More... | |
struct ThrustSetpoint | guidance_v_guided_run (bool in_flight) |
Run GUIDED mode control. More... | |
void | guidance_v_set_z (float z) |
Set z position setpoint. More... | |
void | guidance_v_set_vz (float vz) |
Set z velocity setpoint. More... | |
void | guidance_v_set_th (float th) |
Set throttle setpoint. More... | |
Variables | |
struct VerticalGuidance | guidance_v |
Vertical guidance for rotorcrafts.
Definition in file guidance_v.h.
struct VerticalGuidance |
Definition at line 43 of file guidance_v.h.
Data Fields | ||
---|---|---|
uint8_t | mode | |
float | nominal_throttle |
nominal throttle for hover. This is only used if GUIDANCE_V_NOMINAL_HOVER_THROTTLE is defined! Unit: factor of MAX_PPRZ with range 0.1 : 0.9 |
int32_t | rc_delta_t |
Direct throttle from radio control. range 0:MAX_PPRZ |
int32_t | rc_zd_sp |
Vertical speed setpoint from radio control. fixed point representation: Q12.19 accuracy 0.0000019, range +/-4096 |
int32_t | th_sp |
input thrust setpoint. valid range 0 : MAX_PPRZ |
struct ThrustSetpoint | thrust | Final thrust setpoint summation of feed-forward and feed-back commands, can be a total thrust or increment, float or int. |
int32_t | thrust_coeff | |
int32_t | z_ref |
altitude reference in meters. fixed point representation: Q23.8 accuracy 0.0039, range 8388km |
int32_t | z_sp |
altitude setpoint in meters (input). fixed point representation: Q23.8 accuracy 0.0039, range 8388km |
int32_t | zd_ref |
vertical speed reference in meter/s. fixed point representation: Q12.19 accuracy 0.0000038, range 4096 |
int32_t | zd_sp |
vertical speed setpoint in meter/s (input). fixed point representation: Q12.19 accuracy 0.0000019, range +/-4096 |
int32_t | zdd_ref |
vertical acceleration reference in meter/s^2. fixed point representation: Q21.10 accuracy 0.0009766, range 2097152 |
#define GUIDANCE_V_MODE_CLIMB 3 |
Definition at line 38 of file guidance_v.h.
#define GUIDANCE_V_MODE_GUIDED 6 |
Definition at line 41 of file guidance_v.h.
#define GUIDANCE_V_MODE_HOVER 4 |
Definition at line 39 of file guidance_v.h.
#define GUIDANCE_V_MODE_KILL 0 |
Definition at line 35 of file guidance_v.h.
#define GUIDANCE_V_MODE_NAV 5 |
Definition at line 40 of file guidance_v.h.
#define GUIDANCE_V_MODE_RC_CLIMB 2 |
Definition at line 37 of file guidance_v.h.
#define GUIDANCE_V_MODE_RC_DIRECT 1 |
Definition at line 36 of file guidance_v.h.
#define GuidanceVSetRef guidance_v_set_ref |
Definition at line 129 of file guidance_v.h.
struct ThrustSetpoint guidance_v_from_nav | ( | bool | in_flight | ) |
Set guidance setpoint from NAV and run hover loop.
Definition at line 289 of file guidance_v.c.
References desired_zd_updated, guidance_v, gv_z_ref, GV_Z_REF_FRAC, gv_zd_ref, GV_ZD_REF_FRAC, gv_zdd_ref, GV_ZDD_REF_FRAC, INT32_ACCEL_FRAC, INT32_POS_FRAC, INT32_SPEED_FRAC, VerticalGuidance::z_ref, VerticalGuidance::zd_ref, and VerticalGuidance::zdd_ref.
void guidance_v_guided_enter | ( | void | ) |
Enter GUIDED mode control.
Definition at line 328 of file guidance_v.c.
References guidance_v_run_enter(), guidance_v_set_z(), GuidanceVSetRef, stateGetPositionNed_f(), stateGetPositionNed_i(), and stateGetSpeedNed_i().
Referenced by guidance_v_mode_changed().
struct ThrustSetpoint guidance_v_guided_run | ( | bool | in_flight | ) |
Run GUIDED mode control.
Definition at line 328 of file guidance_v.c.
void guidance_v_init | ( | void | ) |
Definition at line 91 of file guidance_v.c.
References BFP_OF_REAL, DefaultPeriodic, desired_zd_updated, guidance_v, guidance_v_guided_mode, GUIDANCE_V_GUIDED_MODE_ZHOLD, GUIDANCE_V_MODE_KILL, GUIDANCE_V_NOMINAL_HOVER_THROTTLE, GUIDANCE_V_RC_ID, gv_adapt_init(), INT32_TRIG_FRAC, VerticalGuidance::mode, VerticalGuidance::nominal_throttle, rc_cb(), rc_ev, register_periodic_telemetry(), send_tune_vert(), and VerticalGuidance::thrust_coeff.
void guidance_v_mode_changed | ( | uint8_t | new_mode | ) |
Definition at line 132 of file guidance_v.c.
References guidance_v, guidance_v_guided_enter(), GUIDANCE_V_MODE_CLIMB, GUIDANCE_V_MODE_GUIDED, GUIDANCE_V_MODE_HOVER, GUIDANCE_V_MODE_NAV, GUIDANCE_V_MODE_RC_CLIMB, guidance_v_run_enter(), GuidanceVSetRef, VerticalGuidance::mode, stateGetPositionNed_i(), stateGetSpeedNed_i(), and VerticalGuidance::zd_sp.
Referenced by autopilot_static_set_mode(), and guidance_module_enter().
void guidance_v_notify_in_flight | ( | bool | in_flight | ) |
Definition at line 163 of file guidance_v.c.
References gv_adapt_init().
struct ThrustSetpoint guidance_v_run | ( | bool | in_flight | ) |
Guidance vertical run functions.
Definition at line 199 of file guidance_v.c.
References Stabilization::cmd, desired_zd_updated, get_vertical_thrust_coeff(), guidance_v, gv_adapt_init(), gv_adapt_run(), INT32_TRIG_FRAC, stabilization, stateGetAccelNed_i(), VerticalGuidance::thrust_coeff, and VerticalGuidance::zd_ref.
Referenced by autopilot_static_periodic(), and guidance_module_run().
struct ThrustSetpoint guidance_v_run_accel | ( | bool | in_flight, |
struct VerticalGuidance * | gv | ||
) |
Definition at line 45 of file guidance_oneloop.c.
void guidance_v_run_enter | ( | void | ) |
Definition at line 40 of file guidance_oneloop.c.
Referenced by guidance_v_guided_enter(), guidance_v_mode_changed(), and guidance_v_z_enter().
struct ThrustSetpoint guidance_v_run_pos | ( | bool | in_flight, |
struct VerticalGuidance * | gv | ||
) |
Definition at line 45 of file guidance_oneloop.c.
struct ThrustSetpoint guidance_v_run_speed | ( | bool | in_flight, |
struct VerticalGuidance * | gv | ||
) |
Definition at line 45 of file guidance_oneloop.c.
Set guidance ref parameters.
Definition at line 280 of file guidance_v.c.
References guidance_v, gv_set_ref(), VerticalGuidance::z_ref, VerticalGuidance::zd_ref, and VerticalGuidance::zdd_ref.
void guidance_v_set_th | ( | float | th | ) |
Set throttle setpoint.
th | Throttle setpoint between 0. and 1. |
Definition at line 386 of file guidance_v.c.
References guidance_v, guidance_v_guided_mode, GUIDANCE_V_GUIDED_MODE_THROTTLE, GuidanceVSetRef, MAX_PPRZ, stateGetPositionNed_i(), stateGetSpeedNed_i(), and VerticalGuidance::th_sp.
void guidance_v_set_vz | ( | float | vz | ) |
Set z velocity setpoint.
vz | Setpoint (down is positive) in meters/second. |
Definition at line 378 of file guidance_v.c.
References guidance_v, guidance_v_guided_mode, GUIDANCE_V_GUIDED_MODE_CLIMB, SPEED_BFP_OF_REAL, and VerticalGuidance::zd_sp.
Referenced by autopilot_static_set_mode().
void guidance_v_set_z | ( | float | z | ) |
Set z position setpoint.
z | Setpoint (down is positive) in meters. |
Definition at line 368 of file guidance_v.c.
References guidance_v, guidance_v_guided_mode, GUIDANCE_V_GUIDED_MODE_ZHOLD, POS_BFP_OF_REAL, VerticalGuidance::z_sp, and VerticalGuidance::zd_sp.
Referenced by guidance_v_guided_enter().
void guidance_v_thrust_adapt | ( | bool | in_flight | ) |
Definition at line 199 of file guidance_v.c.
void guidance_v_update_ref | ( | void | ) |
Definition at line 289 of file guidance_v.c.
void guidance_v_z_enter | ( | void | ) |
Definition at line 267 of file guidance_v.c.
References guidance_v, guidance_v_run_enter(), GuidanceVSetRef, stateGetPositionNed_i(), NedCoor_i::z, VerticalGuidance::z_sp, and VerticalGuidance::zd_sp.
|
extern |
Definition at line 1 of file guidance_v.c.
Referenced by guidance_v_from_nav(), guidance_v_init(), guidance_v_mode_changed(), guidance_v_run(), guidance_v_set_ref(), guidance_v_set_th(), guidance_v_set_vz(), guidance_v_set_z(), guidance_v_z_enter(), optical_flow_landing_init(), rc_cb(), send_fp(), send_status(), send_tune_vert(), and send_vert_loop().