|
Paparazzi UAS v7.1_unstable
Paparazzi is a free software Unmanned Aircraft System.
|
#include <stdlib.h>#include "mateksys_3901_l0x.h"#include "mcu_periph/uart.h"#include "modules/core/abi.h"#include "state.h"#include "pprzlink/messages.h"#include "modules/datalink/downlink.h"#include "modules/datalink/telemetry.h"Go to the source code of this file.
Macros | |
| #define | MATEKSYS_3901_L0X_MOTION_THRES 100 |
| #define | MATEKSYS_3901_L0X_DISTANCE_THRES 200 |
| #define | MATEKSYS_3901_L0X_MAX_FLOW 300 |
| #define | MATEKSYS_3901_L0X_MAX_DISTANCE 3000 |
| #define | USE_MATEKSYS_3901_L0X_AGL 1 |
| #define | USE_MATEKSYS_3901_L0X_OPTICAL_FLOW 1 |
| #define | MATEKSYS_3901_L0X_COMPENSATE_ROTATION 1 |
| #define | MATEKSYS_3901_L0X_FLOW_X_SCALER 1 |
| #define | MATEKSYS_3901_L0X_FLOW_Y_SCALER 1 |
Functions | |
| static void | mateksys3901l0x_parse (uint8_t byte) |
| Parse the sensor MSP output bytes 1 by 1. | |
| static void | mateksys3901l0x_send_optical_flow (struct transport_tx *trans, struct link_device *dev) |
| Downlink message flow and lidar (included velocity estimation, not yet tested). | |
| void | mateksys3901l0x_init (void) |
| Initialization function. | |
| void | mateksys_3901_l0x_scale_X (float scalex) |
| Scale the Flow X. | |
| void | mateksys_3901_l0x_scale_Y (float scaley) |
| Scale the Flow Y. | |
| void | mateksys3901l0x_event (void) |
| Receive bytes from the UART port and parse them. | |
Variables | |
| struct Mateksys3901l0X | mateksys3901l0x |
| #define MATEKSYS_3901_L0X_COMPENSATE_ROTATION 1 |
Definition at line 67 of file mateksys_3901_l0x.c.
Referenced by mateksys3901l0x_parse().
| #define MATEKSYS_3901_L0X_DISTANCE_THRES 200 |
Definition at line 47 of file mateksys_3901_l0x.c.
Referenced by mateksys3901l0x_parse().
| #define MATEKSYS_3901_L0X_FLOW_X_SCALER 1 |
Definition at line 71 of file mateksys_3901_l0x.c.
Referenced by mateksys3901l0x_init().
| #define MATEKSYS_3901_L0X_FLOW_Y_SCALER 1 |
Definition at line 75 of file mateksys_3901_l0x.c.
Referenced by mateksys3901l0x_init().
| #define MATEKSYS_3901_L0X_MAX_DISTANCE 3000 |
Definition at line 55 of file mateksys_3901_l0x.c.
Referenced by mateksys3901l0x_parse().
| #define MATEKSYS_3901_L0X_MAX_FLOW 300 |
Definition at line 51 of file mateksys_3901_l0x.c.
Referenced by mateksys3901l0x_parse().
| #define MATEKSYS_3901_L0X_MOTION_THRES 100 |
Definition at line 43 of file mateksys_3901_l0x.c.
Referenced by mateksys3901l0x_parse().
| #define USE_MATEKSYS_3901_L0X_AGL 1 |
Definition at line 59 of file mateksys_3901_l0x.c.
Referenced by mateksys3901l0x_parse().
| #define USE_MATEKSYS_3901_L0X_OPTICAL_FLOW 1 |
Definition at line 63 of file mateksys_3901_l0x.c.
Referenced by mateksys3901l0x_parse().
| void mateksys3901l0x_event | ( | void | ) |
Receive bytes from the UART port and parse them.
Definition at line 151 of file mateksys_3901_l0x.c.
References mateksys3901l0x, mateksys3901l0x_parse(), and MATEKSYS_3901_L0X_INITIALIZE.
| void mateksys3901l0x_init | ( | void | ) |
Initialization function.
Definition at line 110 of file mateksys_3901_l0x.c.
References DefaultPeriodic, mateksys3901l0x, mateksys3901l0x_send_optical_flow(), MATEKSYS_3901_L0X_FLOW_X_SCALER, MATEKSYS_3901_L0X_FLOW_Y_SCALER, MATEKSYS_3901_L0X_PARSE_HEAD, and register_periodic_telemetry().
|
static |
Parse the sensor MSP output bytes 1 by 1.
Definition at line 161 of file mateksys_3901_l0x.c.
References AGL_LIDAR_MATEKSYS_3901_L0X_ID, FLOW_OPTICFLOW_MATEKSYS_3901_L0X_ID, get_sys_time_usec(), mateksys3901l0x, MATEKSYS_3901_L0X_COMPENSATE_ROTATION, MATEKSYS_3901_L0X_DISTANCE_THRES, MATEKSYS_3901_L0X_INITIALIZE, MATEKSYS_3901_L0X_MAX_DISTANCE, MATEKSYS_3901_L0X_MAX_FLOW, MATEKSYS_3901_L0X_MOTION_THRES, MATEKSYS_3901_L0X_PARSE_CHECKSUM, MATEKSYS_3901_L0X_PARSE_DIRECTION, MATEKSYS_3901_L0X_PARSE_DISTANCE_B1, MATEKSYS_3901_L0X_PARSE_DISTANCE_B2, MATEKSYS_3901_L0X_PARSE_DISTANCE_B3, MATEKSYS_3901_L0X_PARSE_DISTANCE_B4, MATEKSYS_3901_L0X_PARSE_DISTANCEQUALITY, MATEKSYS_3901_L0X_PARSE_FUNCTION_ID_B1, MATEKSYS_3901_L0X_PARSE_FUNCTION_ID_B2, MATEKSYS_3901_L0X_PARSE_HEAD, MATEKSYS_3901_L0X_PARSE_HEAD2, MATEKSYS_3901_L0X_PARSE_LENGTH, MATEKSYS_3901_L0X_PARSE_MOTIONQUALITY, MATEKSYS_3901_L0X_PARSE_MOTIONX_B1, MATEKSYS_3901_L0X_PARSE_MOTIONX_B2, MATEKSYS_3901_L0X_PARSE_MOTIONX_B3, MATEKSYS_3901_L0X_PARSE_MOTIONX_B4, MATEKSYS_3901_L0X_PARSE_MOTIONY_B1, MATEKSYS_3901_L0X_PARSE_MOTIONY_B2, MATEKSYS_3901_L0X_PARSE_MOTIONY_B3, MATEKSYS_3901_L0X_PARSE_MOTIONY_B4, MATEKSYS_3901_L0X_PARSE_POINTER, MATEKSYS_3901_L0X_PARSE_SIZE, FloatEulers::phi, stateGetNedToBodyEulers_f(), FloatEulers::theta, USE_MATEKSYS_3901_L0X_AGL, and USE_MATEKSYS_3901_L0X_OPTICAL_FLOW.
Referenced by mateksys3901l0x_event().
|
static |
Downlink message flow and lidar (included velocity estimation, not yet tested).
Definition at line 90 of file mateksys_3901_l0x.c.
References dev, and mateksys3901l0x.
Referenced by mateksys3901l0x_init().
| void mateksys_3901_l0x_scale_X | ( | float | scalex | ) |
| void mateksys_3901_l0x_scale_Y | ( | float | scaley | ) |
| struct Mateksys3901l0X mateksys3901l0x |
Definition at line 78 of file mateksys_3901_l0x.c.
Referenced by mateksys3901l0x_event(), mateksys3901l0x_init(), mateksys3901l0x_parse(), mateksys3901l0x_send_optical_flow(), mateksys_3901_l0x_scale_X(), and mateksys_3901_l0x_scale_Y().