Paparazzi UAS v7.1_unstable
Paparazzi is a free software Unmanned Aircraft System.
Loading...
Searching...
No Matches
nav_survey_polygon.h File Reference

Advanced polygon survey for fixedwings from Uni Stuttgart. More...

#include "std.h"
#include "math/pprz_algebra_float.h"
Include dependency graph for nav_survey_polygon.h:
This graph shows which files directly or indirectly include this file:

Go to the source code of this file.

Data Structures

struct  SurveyPolyAdv

Enumerations

enum  SurveyStage {
  ERR , ENTRY , SEG , TURN1 ,
  RET , TURN2
}

Functions

void nav_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_survey_polygon_run (void)
 main navigation routine.

Detailed Description

Advanced polygon survey for fixedwings from Uni Stuttgart.

Definition in file nav_survey_polygon.h.


Data Structure Documentation

◆ SurveyPolyAdv

struct SurveyPolyAdv

Definition at line 47 of file nav_survey_polygon.h.

Collaboration diagram for SurveyPolyAdv:
Data Fields
struct FloatVect2 dir_vec
struct FloatVect2 entry_center
uint8_t poly_count
uint8_t poly_first
float psa_altitude
float psa_min_rad
float psa_shot_dist
float psa_sweep_width
struct FloatVect2 rad_vec
struct FloatVect2 ret_end
struct FloatVect2 ret_start
int return_angle
struct FloatVect2 seg_center1
struct FloatVect2 seg_center2
struct FloatVect2 seg_end
struct FloatVect2 seg_start
int segment_angle
enum SurveyStage stage
struct FloatVect2 sweep_vec

Enumeration Type Documentation

◆ SurveyStage

Enumerator
ERR 
ENTRY 
SEG 
TURN1 
RET 
TURN2 

Definition at line 45 of file nav_survey_polygon.h.

Function Documentation

◆ nav_survey_polygon_run()

bool nav_survey_polygon_run ( void )
extern

main navigation routine.

This is called periodically evaluates the current Position and stage and navigates accordingly.

Returns
True until the survey is finished

Definition at line 232 of file nav_survey_polygon.c.

References CARROT, dc_stop(), dc_survey(), ENTRY, get_two_intersects(), last_x, last_y, nav_approaching_xy(), nav_circle_XY(), nav_init_stage(), nav_points(), NavCourseCloseTo, NavVerticalAltitudeMode, NavVerticalAutoThrottleMode, RET, SEG, stateGetPositionUtm_f(), survey, TURN1, TURN2, VECT2_DIFF, and VECT2_SUM.

Here is the call graph for this function:

◆ nav_survey_polygon_setup()

void nav_survey_polygon_setup ( uint8_t first_wp,
uint8_t size,
float angle,
float sweep_width,
float shot_dist,
float min_rad,
float altitude )
extern

initializes the variables needed for the survey to start

Parameters
first_wpthe first Waypoint of the polygon
sizethe number of points that make up the polygon
angleangle in which to do the flyovers
sweep_widthdistance between the sweeps
shot_distdistance between the shots
min_radminimal radius when navigating
altitudethe altitude that must be reached before the flyover starts

Definition at line 135 of file nav_survey_polygon.c.

References altitude, ENTRY, ERR, FLOAT_VECT2_NORMALIZE, get_two_intersects(), NavVerticalAltitudeMode, NavVerticalAutoThrottleMode, survey, sweep, VECT2_COPY, VECT2_DIFF, VECT2_SMUL, VECT2_SUM, waypoints, FloatVect2::x, and FloatVect2::y.

Here is the call graph for this function: