|
Paparazzi UAS v7.1_unstable
Paparazzi is a free software Unmanned Aircraft System.
|
mission navigation for rotorcrafts More...
#include <stdio.h>#include "modules/mission/mission_common.h"#include "autopilot.h"#include "firmwares/rotorcraft/navigation.h"#include "generated/flight_plan.h"Go to the source code of this file.
Macros | |
| #define | BUFFER_ZONE_DIST 10 |
| #define | MISSION_PATH_SKIP_GOTO FALSE |
| #define | MISSION_WAIT_TIMEOUT 30 |
| Implement waiting pattern Only called when MISSION_WAIT_TIMEOUT is not 0. | |
Functions | |
| bool | mission_point_of_lla (struct EnuCoor_f *point, struct LlaCoor_i *lla) |
| Utility function: converts lla (int) to local point (float). | |
| static bool | mission_nav_wp (struct _mission_element *el) |
| Navigation function to a single waypoint. | |
| static bool | mission_nav_circle (struct _mission_element *el) |
| Navigation function on a circle. | |
| static bool | mission_nav_segment (struct _mission_element *el) |
| Navigation function along a segment. | |
| static bool | mission_nav_path (struct _mission_element *el) |
| Navigation function along a path. | |
| static bool | mission_nav_custom (struct _mission_custom *custom, bool init) |
| Call custom navigation function. | |
| static bool | mission_wait_pattern (void) |
| int | mission_run () |
| Run mission. | |
Variables | |
| static const float | dt_navigation = 1.0f / ((float)NAVIGATION_FREQUENCY) |
| struct EnuCoor_f | last_mission_wp = { 0.f, 0.f, 0.f } |
| static bool | mission_wait_started = false |
mission navigation for rotorcrafts
Implement specific navigation routines for the mission control of a rotorcraft
Definition in file mission_rotorcraft_nav.c.
| #define BUFFER_ZONE_DIST 10 |
Definition at line 38 of file mission_rotorcraft_nav.c.
Referenced by mission_point_of_lla().
| #define MISSION_PATH_SKIP_GOTO FALSE |
Definition at line 160 of file mission_rotorcraft_nav.c.
Referenced by mission_nav_path(), and mission_nav_path().
| #define MISSION_WAIT_TIMEOUT 30 |
Implement waiting pattern Only called when MISSION_WAIT_TIMEOUT is not 0.
Definition at line 219 of file mission_rotorcraft_nav.c.
|
inlinestatic |
Navigation function on a circle.
Definition at line 113 of file mission_rotorcraft_nav.c.
References _mission_element::duration, _mission_element::element, mission, nav, NavVerticalAltitudeMode, NavVerticalAutoThrottleMode, and EnuCoor_f::z.
Referenced by mission_run().
|
inlinestatic |
Call custom navigation function.
Definition at line 206 of file mission_rotorcraft_nav.c.
References _mission_registered::cb, init, MissionInit, MissionRun, _mission_custom::nb, _mission_custom::params, and _mission_custom::reg.
Referenced by mission_run().
|
inlinestatic |
Navigation function along a path.
Definition at line 165 of file mission_rotorcraft_nav.c.
References CARROT, _mission_element::duration, _mission_element::element, last_mission_wp, mission_nav_wp(), MISSION_PATH_SKIP_GOTO, nav, nav_check_wp_time(), NavVerticalAltitudeMode, NavVerticalAutoThrottleMode, stateGetPositionEnu_f(), and EnuCoor_f::z.
Referenced by mission_run().
|
inlinestatic |
Navigation function along a segment.
Definition at line 132 of file mission_rotorcraft_nav.c.
References CARROT, _mission_element::duration, _mission_element::element, last_mission_wp, nav, nav_check_wp_time(), NavVerticalAltitudeMode, NavVerticalAutoThrottleMode, stateGetPositionEnu_f(), and EnuCoor_f::z.
Referenced by mission_run().
|
inlinestatic |
Navigation function to a single waypoint.
Definition at line 86 of file mission_rotorcraft_nav.c.
References CARROT, _mission_element::duration, _mission_element::element, last_mission_wp, nav, nav_check_wp_time(), NavVerticalAltitudeMode, NavVerticalAutoThrottleMode, stateGetPositionEnu_f(), and EnuCoor_f::z.
Referenced by mission_nav_path(), and mission_run().
Utility function: converts lla (int) to local point (float).
Get the ENU component of LLA mission point This function is firmware specific.
TODO: don't convert to float, either use double or do completely in fixed point
Definition at line 41 of file mission_rotorcraft_nav.c.
References LlaCoor_i::alt, BUFFER_ZONE_DIST, enu_of_lla_point_i(), float_vect2_norm(), state, stateGetHmslOrigin_i(), stateGetLlaOrigin_i(), stateGetNedOrigin_i(), VECT2_DIFF, VECT2_SMUL, VECT2_SUM, VECT3_SMUL, waypoint_get_x(), waypoint_get_y(), FloatVect2::x, FloatVect2::y, and EnuCoor_f::z.
| int mission_run | ( | void | ) |
Run mission.
This function should be implemented into a dedicated file since navigation functions are different for different firmwares
Currently, this function should be called from the flight plan
Definition at line 242 of file mission_rotorcraft_nav.c.
References dt_navigation, _mission_element::element, mission, MISSION_ELEMENT_NB, mission_get(), mission_nav_circle(), mission_nav_custom(), mission_nav_path(), mission_nav_segment(), mission_nav_wp(), mission_wait_pattern(), mission_wait_started, MissionCircle, MissionCustom, MissionPath, MissionSegment, MissionWP, and _mission_element::type.
|
static |
Definition at line 237 of file mission_rotorcraft_nav.c.
Referenced by mission_run().
|
static |
Definition at line 79 of file mission_rotorcraft_nav.c.
Definition at line 82 of file mission_rotorcraft_nav.c.
Referenced by mission_nav_path(), mission_nav_path(), mission_nav_segment(), mission_nav_segment(), mission_nav_wp(), and mission_nav_wp().
|
static |
Definition at line 222 of file mission_rotorcraft_nav.c.