36#include "pprzlink/messages.h"
42#define LIDAR_OFFSET 0.0f
47#define LIDAR_HEIGHT 0.0f
66 pprz_msg_send_LIDAR(trans,
dev, AC_ID,
79 tfmini.device = &((TFMINI_PORT).device);
81 tfmini.update_agl = USE_TFMINI_AGL;
82 tfmini.compensate_rotation = TFMINI_COMPENSATE_ROTATION;
83 tfmini.is_rover = TFMINI_ROVER;
115 switch (
tfmini.parse_status) {
139 tfmini.raw_dist |= (
byte << 8);
145 tfmini.raw_strength = byte;
150 tfmini.raw_strength |= (
byte << 8);
167 if (
tfmini.parse_crc ==
byte) {
173 if (
tfmini.distance != 0xFFFF) {
175 if (
tfmini.compensate_rotation) {
179 float ground_distance;
180 if (fabs(theta) < 0.01) {
181 ground_distance = 100;
186 if ((
tfmini.distance >= ground_distance) && (ground_distance > 0)) {
194 float gain = (float)fabs((
double)(cosf(phi) * cosf(theta)));
223#ifndef USE_SERVO_LIDAR
Main include for ABI (AirBorneInterface).
#define AGL_LIDAR_TFMINI_ID
uint32_t get_sys_time_usec(void)
Get the time in microseconds since startup.
Common code for AP and FBW telemetry.
static struct uart_periph * dev
static struct FloatEulers * stateGetNedToBodyEulers_f(void)
Get vehicle body attitude euler angles (float).
API to get/set the generic vehicle states.
int16_t register_periodic_telemetry(struct periodic_telemetry *_pt, uint16_t _id, telemetry_cb _cb)
Register a telemetry callback function.
Periodic telemetry system header (includes downlink utility and generated code).
#define DefaultPeriodic
Set default periodic telemetry.
void tfmini_event(void)
Lidar event function Receive bytes from the UART port and parse them.
void tfmini_parse(uint8_t byte)
Parse the lidar bytes 1 by 1.
static float lidar_height
static void tfmini_send_lidar(struct transport_tx *trans, struct link_device *dev)
Downlink message lidar.
void tfmini_send_abi(void)
void tfmini_init(void)
Initialization function.
static float lidar_offset
driver for the TFMini lidar
@ TFMINI_PARSE_STRENGTH_L
@ TFMINI_PARSE_STRENGTH_H
arch independent UART (Universal Asynchronous Receiver/Transmitter) API
unsigned int uint32_t
Typedef defining 32 bit unsigned int type.
unsigned char uint8_t
Typedef defining 8 bit unsigned char type.