You can not select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
41 lines
917 B
41 lines
917 B
#pragma once |
|
|
|
#include "AP_OpticalFlow.h" |
|
|
|
#ifndef AP_OPTICALFLOW_HEREFLOW_ENABLED |
|
#define AP_OPTICALFLOW_HEREFLOW_ENABLED (AP_OPTICALFLOW_ENABLED && HAL_ENABLE_LIBUAVCAN_DRIVERS) |
|
#endif |
|
|
|
#if AP_OPTICALFLOW_HEREFLOW_ENABLED |
|
|
|
#include <AP_UAVCAN/AP_UAVCAN.h> |
|
|
|
class MeasurementCb; |
|
|
|
class AP_OpticalFlow_HereFlow : public OpticalFlow_backend { |
|
public: |
|
AP_OpticalFlow_HereFlow(AP_OpticalFlow &flow); |
|
|
|
void init() override {} |
|
|
|
void update() override; |
|
|
|
static void subscribe_msgs(AP_UAVCAN* ap_uavcan); |
|
|
|
static void handle_measurement(AP_UAVCAN* ap_uavcan, uint8_t node_id, const MeasurementCb &cb); |
|
|
|
private: |
|
|
|
Vector2f flowRate, bodyRate; |
|
uint8_t surface_quality; |
|
float integral_time; |
|
bool new_data; |
|
static uint8_t _node_id; |
|
|
|
static AP_OpticalFlow_HereFlow* _driver; |
|
static AP_UAVCAN* _ap_uavcan; |
|
void _push_state(void); |
|
|
|
}; |
|
|
|
#endif // AP_OPTICALFLOW_HEREFLOW_ENABLED
|
|
|