|
Paparazzi UAS v7.1_unstable
Paparazzi is a free software Unmanned Aircraft System.
|
Basic guidance for rover. More...
#include "firmwares/rover/guidance/rover_guidance_holonomic.h"#include "generated/airframe.h"#include "generated/autopilot_core_guidance.h"#include "state.h"#include "modules/datalink/telemetry.h"Go to the source code of this file.
Macros | |
| #define | AUTOPILOT_CORE_GUIDANCE_C |
| #define | MAX_POS_ERR 10.f |
| #define | MAX_SPEED_ERR 10.f |
| #define | MAX_INTEGRAL_CMD (MAX_PPRZ / 10.f) |
| #define | PROXIMITY_DIST 0.2f |
Functions | |
| void | rover_holo_guidance_init (void) |
| void | rover_holo_guidance_periodic (void) |
| static float | compute_pid (struct RoverHoloGuidancePID *pid) |
| void | rover_holo_guidance_run (float *heading_sp) |
| void | rover_holo_guidance_enter (void) |
| void | rover_guidance_holonomic_set_speed_igain (float igain) |
| void | rover_guidance_holonomic_set_turn_igain (float igain) |
Variables | |
| struct RoverHoloGuidance | rover_holo_guidance |
Basic guidance for rover.
Implement standard PID control loop to track a navigation target. Guidance "modes" are using the autopilot generation with the "guidance" state machine.
Definition in file rover_guidance_holonomic.c.
| #define AUTOPILOT_CORE_GUIDANCE_C |
Definition at line 29 of file rover_guidance_holonomic.c.
Definition at line 81 of file rover_guidance_holonomic.c.
| #define MAX_POS_ERR 10.f |
Definition at line 79 of file rover_guidance_holonomic.c.
| #define MAX_SPEED_ERR 10.f |
Definition at line 80 of file rover_guidance_holonomic.c.
| #define PROXIMITY_DIST 0.2f |
Definition at line 82 of file rover_guidance_holonomic.c.
|
static |
Definition at line 74 of file rover_guidance_holonomic.c.
References RoverHoloGuidancePID::d, RoverHoloGuidancePID::d_err, RoverHoloGuidancePID::err, RoverHoloGuidancePID::i, RoverHoloGuidancePID::p, and RoverHoloGuidancePID::sum_err.
Referenced by rover_holo_guidance_run().
| void rover_guidance_holonomic_set_speed_igain | ( | float | igain | ) |
Definition at line 141 of file rover_guidance_holonomic.c.
References rover_holo_guidance.
| void rover_guidance_holonomic_set_turn_igain | ( | float | igain | ) |
Definition at line 147 of file rover_guidance_holonomic.c.
References rover_holo_guidance.
| void rover_holo_guidance_enter | ( | void | ) |
Definition at line 131 of file rover_guidance_holonomic.c.
References FloatEulers::psi, rover_holo_guidance, and stateGetNedToBodyEulers_f().
| void rover_holo_guidance_init | ( | void | ) |
Definition at line 43 of file rover_guidance_holonomic.c.
References FLOAT_VECT2_ZERO, and rover_holo_guidance.
| void rover_holo_guidance_periodic | ( | void | ) |
Definition at line 68 of file rover_guidance_holonomic.c.
| void rover_holo_guidance_run | ( | float * | heading_sp | ) |
Definition at line 84 of file rover_guidance_holonomic.c.
References compute_pid(), float_vect2_norm(), MAX_POS_ERR, MAX_PPRZ, MAX_SPEED_ERR, PROXIMITY_DIST, FloatEulers::psi, FloatRates::r, rover_holo_guidance, stateGetBodyRates_f(), stateGetHorizontalSpeedNorm_f(), stateGetNedToBodyEulers_f(), stateGetPositionNed_f(), TRIM_PPRZ, VECT2_DIFF, FloatVect2::x, and FloatVect2::y.
| struct RoverHoloGuidance rover_holo_guidance |
Definition at line 36 of file rover_guidance_holonomic.c.
Referenced by rover_guidance_holonomic_set_speed_igain(), rover_guidance_holonomic_set_turn_igain(), rover_holo_guidance_enter(), rover_holo_guidance_init(), and rover_holo_guidance_run().