Paparazzi UAS v7.1_unstable
Paparazzi is a free software Unmanned Aircraft System.
Loading...
Searching...
No Matches
nav_rover_base.c File Reference
Include dependency graph for nav_rover_base.c:

Go to the source code of this file.

Macros

#define LINE_START_FUNCTION   {}
 Navigation along a figure O.
#define LINE_STOP_FUNCTION   {}

Functions

static void nav_stage_init (void)
 Implement basic nav function.
static void nav_goto (struct EnuCoor_f *wp)
static void nav_route (struct EnuCoor_f *wp_start, struct EnuCoor_f *wp_end)
static bool nav_approaching (struct EnuCoor_f *wp, struct EnuCoor_f *from, float approaching_time)
static void nav_circle (struct EnuCoor_f *wp_center, float radius)
static void _nav_oval_init (void)
static void nav_oval (struct EnuCoor_f *wp1, struct EnuCoor_f *wp2, float radius)
static void send_nav_status (struct transport_tx *trans, struct link_device *dev)
void nav_rover_init (void)
 Init and register nav functions.

Variables

struct RoverNavBase nav_rover_base

Detailed Description

Author
2018 Gautier Hattenberger gauti.nosp@m.er.h.nosp@m.atten.nosp@m.berg.nosp@m.er@en.nosp@m.ac.f.nosp@m.r Basic navigation functions for Rovers

Definition in file nav_rover_base.c.

Macro Definition Documentation

◆ LINE_START_FUNCTION

#define LINE_START_FUNCTION   {}

Navigation along a figure O.

One side leg is defined by waypoints [p1] and [p2]. The navigation goes through 4 states: OC1 (half circle next to [p1]), OR21 (route [p2] to [p1], OC2 (half circle next to [p2]) and OR12 (opposite leg). Initial state is the route along the desired segment (OC2).

Definition at line 154 of file nav_rover_base.c.

◆ LINE_STOP_FUNCTION

#define LINE_STOP_FUNCTION   {}

Definition at line 157 of file nav_rover_base.c.

Function Documentation

◆ _nav_oval_init()

void _nav_oval_init ( void )
static

Definition at line 160 of file nav_rover_base.c.

References nav_rover_base, and OC2.

◆ nav_approaching()

bool nav_approaching ( struct EnuCoor_f * wp,
struct EnuCoor_f * from,
float approaching_time )
static

Definition at line 70 of file nav_rover_base.c.

References ARRIVED_AT_WAYPOINT, float_vect2_norm(), stateGetPositionEnu_f(), stateGetSpeedEnu_f(), VECT2_DIFF, VECT2_SMUL, VECT2_SUM, FloatVect2::x, and FloatVect2::y.

Here is the call graph for this function:

◆ nav_circle()

void nav_circle ( struct EnuCoor_f * wp_center,
float radius )
static

Definition at line 110 of file nav_rover_base.c.

References CARROT_DIST, Min, nav, NAV_MODE_CIRCLE, nav_rover_base, pos_diff, stateGetPositionEnu_f(), VECT2_ASSIGN, VECT2_COPY, VECT2_DIFF, and VECT2_SUM.

Here is the call graph for this function:

◆ nav_goto()

void nav_goto ( struct EnuCoor_f * wp)
static

Definition at line 40 of file nav_rover_base.c.

References get_dist2_to_point(), nav, NAV_MODE_WAYPOINT, nav_rover_base, and VECT3_COPY.

Here is the call graph for this function:

◆ nav_oval()

void nav_oval ( struct EnuCoor_f * wp1,
struct EnuCoor_f * wp2,
float radius )
static

◆ nav_route()

void nav_route ( struct EnuCoor_f * wp_start,
struct EnuCoor_f * wp_end )
static

Definition at line 48 of file nav_rover_base.c.

References CARROT_DIST, get_dist2_to_point(), nav, NAV_MODE_ROUTE, nav_rover_base, pos_diff, stateGetPositionEnu_f(), VECT2_DIFF, VECT2_SMUL, VECT2_SUM, FloatVect2::x, and FloatVect2::y.

Here is the call graph for this function:

◆ nav_rover_init()

◆ nav_stage_init()

void nav_stage_init ( void )
static

Implement basic nav function.

Definition at line 34 of file nav_rover_base.c.

References nav_rover_base.

◆ send_nav_status()

void send_nav_status ( struct transport_tx * trans,
struct link_device * dev )
static

Definition at line 270 of file nav_rover_base.c.

References block_time, dev, nav, nav_block, NAV_MODE_CIRCLE, NAV_MODE_ROUTE, nav_rover_base, nav_stage, send_circle(), send_segment(), and stage_time.

Here is the call graph for this function:

Variable Documentation

◆ nav_rover_base