Paparazzi UAS
v5.12_stable-4-g9b43e9b
Paparazzi is a free software Unmanned Aircraft System.
|
Optical-flow based control for Linux based systems. More...
#include "guidance_opticflow_hover.h"
#include "subsystems/abi.h"
#include "firmwares/rotorcraft/stabilization/stabilization_attitude.h"
#include "firmwares/rotorcraft/guidance/guidance_v.h"
#include "autopilot.h"
#include "subsystems/datalink/downlink.h"
Go to the source code of this file.
Macros | |
#define | VISION_VELOCITY_ESTIMATE_ID ABI_BROADCAST |
Default sender to accect VELOCITY_ESTIMATE messages from. More... | |
#define | CMD_OF_SAT 1500 |
#define | VISION_PHI_PGAIN 400 |
#define | VISION_PHI_IGAIN 20 |
#define | VISION_THETA_PGAIN 400 |
#define | VISION_THETA_IGAIN 20 |
#define | VISION_DESIRED_VX 0 |
#define | VISION_DESIRED_VY 0 |
Functions | |
static void | stabilization_opticflow_vel_cb (uint8_t sender_id, uint32_t stamp, float vel_x, float vel_y, float vel_z, float noise) |
Update the controls on a new VELOCITY_ESTIMATE ABI message. More... | |
void | guidance_h_module_init (void) |
Initialization of horizontal guidance module. More... | |
void | guidance_h_module_enter (void) |
Horizontal guidance mode enter resets the errors and starts the controller. More... | |
void | guidance_h_module_read_rc (void) |
Read the RC commands. More... | |
void | guidance_h_module_run (bool in_flight) |
Main guidance loop. More... | |
Variables | |
static abi_event | velocity_est_ev |
struct opticflow_stab_t | opticflow_stab |
Optical-flow based control for Linux based systems.
Control loops for optic flow based hovering. Computes setpoint for the lower level attitude stabilization to control horizontal velocity.
Definition in file guidance_opticflow_hover.c.
#define CMD_OF_SAT 1500 |
Definition at line 47 of file guidance_opticflow_hover.c.
Referenced by stabilization_opticflow_vel_cb().
#define VISION_DESIRED_VX 0 |
Definition at line 70 of file guidance_opticflow_hover.c.
#define VISION_DESIRED_VY 0 |
Definition at line 75 of file guidance_opticflow_hover.c.
#define VISION_PHI_IGAIN 20 |
Definition at line 55 of file guidance_opticflow_hover.c.
#define VISION_PHI_PGAIN 400 |
Definition at line 50 of file guidance_opticflow_hover.c.
#define VISION_THETA_IGAIN 20 |
Definition at line 65 of file guidance_opticflow_hover.c.
#define VISION_THETA_PGAIN 400 |
Definition at line 60 of file guidance_opticflow_hover.c.
#define VISION_VELOCITY_ESTIMATE_ID ABI_BROADCAST |
Default sender to accect VELOCITY_ESTIMATE messages from.
Definition at line 43 of file guidance_opticflow_hover.c.
Referenced by guidance_h_module_init().
void guidance_h_module_enter | ( | void | ) |
Horizontal guidance mode enter resets the errors and starts the controller.
Definition at line 115 of file guidance_opticflow_hover.c.
References opticflow_stab_t::cmd, opticflow_stab_t::err_vx_int, opticflow_stab_t::err_vy_int, Int32Eulers::phi, Int32Eulers::psi, stateGetNedToBodyEulers_i(), and Int32Eulers::theta.
void guidance_h_module_init | ( | void | ) |
Initialization of horizontal guidance module.
Definition at line 105 of file guidance_opticflow_hover.c.
References stabilization_opticflow_vel_cb(), and VISION_VELOCITY_ESTIMATE_ID.
void guidance_h_module_read_rc | ( | void | ) |
Read the RC commands.
Definition at line 130 of file guidance_opticflow_hover.c.
void guidance_h_module_run | ( | bool | in_flight | ) |
Main guidance loop.
[in] | in_flight | Whether we are in flight or not |
Definition at line 139 of file guidance_opticflow_hover.c.
References opticflow_stab_t::cmd, stabilization_attitude_run(), and stabilization_attitude_set_rpy_setpoint_i().
|
static |
Update the controls on a new VELOCITY_ESTIMATE ABI message.
Definition at line 151 of file guidance_opticflow_hover.c.
References AP_MODE_MODULE, autopilot_get_mode(), opticflow_stab_t::cmd, CMD_OF_SAT, opticflow_stab_t::desired_vx, opticflow_stab_t::desired_vy, err_vx, opticflow_stab_t::err_vx_int, err_vy, opticflow_stab_t::err_vy_int, Int32Eulers::phi, opticflow_stab_t::phi_igain, opticflow_stab_t::phi_pgain, Int32Eulers::theta, opticflow_stab_t::theta_igain, and opticflow_stab_t::theta_pgain.
Referenced by guidance_h_module_init().
struct opticflow_stab_t opticflow_stab |
Definition at line 90 of file guidance_opticflow_hover.c.
|
static |
Definition at line 87 of file guidance_opticflow_hover.c.