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

Guiding vector field algorithm for 2D and 3D complex trajectories. More...

#include <iostream>
#include <Eigen/Dense>
#include "gvf_parametric.h"
#include "autopilot.h"
#include "gvf_adapted_step.h"
#include "modules/datalink/telemetry.h"
Include dependency graph for gvf_parametric.cpp:

Go to the source code of this file.

Macros

#define GVF_PARAMETRIC_CONTROL_KROLL   1
#define GVF_PARAMETRIC_CONTROL_KCLIMB   1
#define GVF_PARAMETRIC_CONTROL_L   0.1
#define GVF_PARAMETRIC_CONTROL_BETA   0.01
#define GVF_PARAMETRIC_CONTROL_KPSI   1

Functions

static void send_gvf_parametric (struct transport_tx *trans, struct link_device *dev)
 TELEMETRY -----------------------------------------------------------—.
void gvf_parametric_init (void)
void gvf_parametric_control_2D (float kx, float ky, float f1, float f2, float f1d, float f2d, float f1dd, float f2dd)
void gvf_parametric_set_direction (int8_t s)

Variables

gvf_parametric_con gvf_parametric_control
gvf_parametric_tel gvf_parametric_telemetry = {{0}, 1, 0}
uint32_t gvf_parametric_t0 = 0

Detailed Description

Guiding vector field algorithm for 2D and 3D complex trajectories.

Definition in file gvf_parametric.cpp.

Macro Definition Documentation

◆ GVF_PARAMETRIC_CONTROL_BETA

#define GVF_PARAMETRIC_CONTROL_BETA   0.01

Default scale for w

Definition at line 56 of file gvf_parametric.cpp.

Referenced by gvf_parametric_init().

◆ GVF_PARAMETRIC_CONTROL_KCLIMB

#define GVF_PARAMETRIC_CONTROL_KCLIMB   1

Default gain kclimb for tuning the climbing setting point

Definition at line 39 of file gvf_parametric.cpp.

Referenced by gvf_parametric_init().

◆ GVF_PARAMETRIC_CONTROL_KPSI

#define GVF_PARAMETRIC_CONTROL_KPSI   1

Default gain kpsi for tuning the alignment of the vehicle with the vector field

Definition at line 63 of file gvf_parametric.cpp.

Referenced by gvf_parametric_init().

◆ GVF_PARAMETRIC_CONTROL_KROLL

#define GVF_PARAMETRIC_CONTROL_KROLL   1

Default gain kroll for tuning the "coordinated turn"

Definition at line 34 of file gvf_parametric.cpp.

Referenced by gvf_parametric_init().

◆ GVF_PARAMETRIC_CONTROL_L

#define GVF_PARAMETRIC_CONTROL_L   0.1

Default scale for the error signals

Definition at line 47 of file gvf_parametric.cpp.

Referenced by gvf_parametric_init().

Function Documentation

◆ gvf_parametric_control_2D()

void gvf_parametric_control_2D ( float kx,
float ky,
float f1,
float f2,
float f1d,
float f2d,
float f1dd,
float f2dd )

◆ gvf_parametric_init()

◆ gvf_parametric_set_direction()

void gvf_parametric_set_direction ( int8_t s)

Definition at line 437 of file gvf_parametric.cpp.

References gvf_parametric_control, and s.

◆ send_gvf_parametric()

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

TELEMETRY -----------------------------------------------------------—.

Definition at line 85 of file gvf_parametric.cpp.

References dev, get_sys_time_msec(), gvf_parametric_control, gvf_parametric_t0, gvf_parametric_telemetry, and gvf_parametric_trajectory.

Referenced by gvf_parametric_init().

Here is the call graph for this function:
Here is the caller graph for this function:

Variable Documentation

◆ gvf_parametric_control

◆ gvf_parametric_t0

uint32_t gvf_parametric_t0 = 0

Definition at line 79 of file gvf_parametric.cpp.

Referenced by gvf_parametric_control_2D(), and send_gvf_parametric().

◆ gvf_parametric_telemetry

gvf_parametric_tel gvf_parametric_telemetry = {{0}, 1, 0}