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

interface to TU Delft serial stereocam Include stereocam.xml to your airframe file. More...

#include "modules/stereocam/stereocam.h"
#include "mcu_periph/uart.h"
#include "modules/datalink/telemetry.h"
#include "pprzlink/messages.h"
#include "pprzlink/intermcu_msg.h"
#include "mcu_periph/sys_time.h"
#include "modules/core/abi.h"
#include "stereocam_follow_me/follow_me.h"
#include "filters/median_filter.h"
Include dependency graph for stereocam.c:

Go to the source code of this file.

Macros

#define FORWARD_IMAGE_DATA   FALSE
#define STEREO_BODY_TO_STEREO_PHI   0
#define STEREO_BODY_TO_STEREO_THETA   0
#define STEREO_BODY_TO_STEREO_PSI   0
#define STEREOCAM_USE_MEDIAN_FILTER   0

Functions

void stereocam_init (void)
static void stereocam_parse_msg (void)
void stereocam_event (void)
void state2stereocam (void)

Variables

struct stereocam_t stereocam
static uint8_t stereocam_msg_buf [256]
 The message buffer for the stereocamera.
struct MedianFilter3Float medianfilter

Detailed Description

interface to TU Delft serial stereocam Include stereocam.xml to your airframe file.

Parameters STEREO_PORT, STEREO_BAUD, SEND_STEREO should be configured with stereocam.xml.

Definition in file stereocam.c.

Macro Definition Documentation

◆ FORWARD_IMAGE_DATA

#define FORWARD_IMAGE_DATA   FALSE

Definition at line 44 of file stereocam.c.

◆ STEREO_BODY_TO_STEREO_PHI

#define STEREO_BODY_TO_STEREO_PHI   0

Definition at line 71 of file stereocam.c.

Referenced by stereocam_init().

◆ STEREO_BODY_TO_STEREO_PSI

#define STEREO_BODY_TO_STEREO_PSI   0

Definition at line 79 of file stereocam.c.

Referenced by stereocam_init().

◆ STEREO_BODY_TO_STEREO_THETA

#define STEREO_BODY_TO_STEREO_THETA   0

Definition at line 75 of file stereocam.c.

Referenced by stereocam_init().

◆ STEREOCAM_USE_MEDIAN_FILTER

#define STEREOCAM_USE_MEDIAN_FILTER   0

Definition at line 89 of file stereocam.c.

Referenced by stereocam_parse_msg().

Function Documentation

◆ state2stereocam()

void state2stereocam ( void )

Definition at line 216 of file stereocam.c.

References float_rmat_mult(), FloatEulers::phi, FloatEulers::psi, stateGetNedToBodyEulers_f(), stereocam, and FloatEulers::theta.

Here is the call graph for this function:

◆ stereocam_event()

void stereocam_event ( void )

Definition at line 202 of file stereocam.c.

References stereocam, stereocam_msg_buf, and stereocam_parse_msg().

Here is the call graph for this function:

◆ stereocam_init()

◆ stereocam_parse_msg()

void stereocam_parse_msg ( void )
static

Definition at line 107 of file stereocam.c.

References DefaultChannel, DefaultDevice, float_rmat_transp_vmult(), follow_me(), get_sys_time_usec(), h(), medianfilter, stereocam, stereocam_msg_buf, STEREOCAM_USE_MEDIAN_FILTER, UpdateMedianFilterVect3Float, VEL_STEREOCAM_ID, FloatVect3::x, FloatVect3::y, and FloatVect3::z.

Referenced by stereocam_event().

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

Variable Documentation

◆ medianfilter

struct MedianFilter3Float medianfilter

Definition at line 93 of file stereocam.c.

Referenced by stereocam_init(), and stereocam_parse_msg().

◆ stereocam

struct stereocam_t stereocam
Initial value:
= {
.device = (&((UART_LINK).device)),
.msg_available = false
}

Definition at line 82 of file stereocam.c.

Referenced by state2stereocam(), stereocam_event(), stereocam_init(), and stereocam_parse_msg().

◆ stereocam_msg_buf

uint8_t stereocam_msg_buf[256]
static

The message buffer for the stereocamera.

Definition at line 86 of file stereocam.c.

Referenced by stereocam_event(), and stereocam_parse_msg().