|
Paparazzi UAS v7.1_unstable
Paparazzi is a free software Unmanned Aircraft System.
|
#include "nav_survey_polygon_gvf.h"#include "firmwares/fixedwing/nav.h"#include "state.h"#include "autopilot.h"#include "generated/flight_plan.h"#include "modules/guidance/gvf/gvf.h"Go to the source code of this file.
Functions | |
| static void | gvf_circle_direction (float rad) |
| static bool | gvf_intercept_two_lines (struct FloatVect2 *p, struct FloatVect2 x, struct FloatVect2 y, float a1, float a2, float b1, float b2) |
| Intercept two lines and give back the point of intersection. | |
| static bool | gvf_get_two_intersects (struct FloatVect2 *x, struct FloatVect2 *y, struct FloatVect2 a, struct FloatVect2 b) |
| Intersects a line with the polygon and gives back the two intersection points. | |
| void | nav_gvf_survey_polygon_setup (uint8_t first_wp, uint8_t size, float angle, float sweep_width, float shot_dist, float min_rad, float altitude) |
| Initializes the variables needed for the survey to start. | |
| bool | nav_gvf_survey_polygon_run (void) |
| Main navigation routine. | |
Variables | |
| struct gvf_SurveyPolyAdv | gvf_survey |
|
static |
Definition at line 46 of file nav_survey_polygon_gvf.c.
References gvf_set_direction().
Referenced by nav_gvf_survey_polygon_run().
|
static |
Intersects a line with the polygon and gives back the two intersection points.
| x,y | intersection points |
| a,b | define the line to intersection |
Definition at line 86 of file nav_survey_polygon_gvf.c.
References b, gvf_intercept_two_lines(), gvf_survey, waypoints, FloatVect2::x, and FloatVect2::y.
Referenced by nav_gvf_survey_polygon_run(), and nav_gvf_survey_polygon_setup().
|
static |
Intercept two lines and give back the point of intersection.
| p | returns intersection |
| x,y | first line is defined by point x and y (goes through this points) |
| a1,a2,b1,b2 | second line by coordinates a1/a2, b1/b2 |
Definition at line 63 of file nav_survey_polygon_gvf.c.
References p, FloatVect2::x, and FloatVect2::y.
Referenced by gvf_get_two_intersects().
| bool nav_gvf_survey_polygon_run | ( | void | ) |
Main navigation routine.
This is called periodically evaluates the current Position and stage and navigates accordingly.
Definition at line 246 of file nav_survey_polygon_gvf.c.
References CARROT, dc_stop(), dc_survey(), gENTRY, gRET, gSEG, gTURN1, gTURN2, gvf_circle_direction(), gvf_get_two_intersects(), gvf_survey, last_x, last_y, nav_approaching_xy(), nav_gvf_ellipse_XY(), nav_gvf_segment_points(), nav_init_stage(), NavCourseCloseTo, NavVerticalAltitudeMode, NavVerticalAutoThrottleMode, stateGetPositionUtm_f(), VECT2_DIFF, and VECT2_SUM.
| void nav_gvf_survey_polygon_setup | ( | uint8_t | first_wp, |
| uint8_t | size, | ||
| float | angle, | ||
| float | sweep_width, | ||
| float | shot_dist, | ||
| float | min_rad, | ||
| float | altitude ) |
Initializes the variables needed for the survey to start.
| first_wp | the first Waypoint of the polygon |
| size | the number of points that make up the polygon |
| angle | angle in which to do the flyovers |
| sweep_width | distance between the sweeps |
| shot_dist | distance between the shots |
| min_rad | minimal radius when navigating |
| altitude | the altitude that must be reached before the flyover starts |
Definition at line 145 of file nav_survey_polygon_gvf.c.
References altitude, FLOAT_VECT2_NORMALIZE, gENTRY, gERR, gvf_get_two_intersects(), gvf_survey, NavVerticalAltitudeMode, NavVerticalAutoThrottleMode, sweep, VECT2_COPY, VECT2_DIFF, VECT2_SMUL, VECT2_SUM, waypoints, FloatVect2::x, and FloatVect2::y.
| struct gvf_SurveyPolyAdv gvf_survey |
Definition at line 42 of file nav_survey_polygon_gvf.c.
Referenced by gvf_get_two_intersects(), nav_gvf_survey_polygon_run(), and nav_gvf_survey_polygon_setup().