2018-05-25 22:59:36 -03:00
|
|
|
#pragma once
|
|
|
|
|
|
|
|
#include "RangeFinder.h"
|
|
|
|
#include "RangeFinder_Backend.h"
|
|
|
|
|
|
|
|
class AP_RangeFinder_Benewake : public AP_RangeFinder_Backend
|
|
|
|
{
|
|
|
|
|
|
|
|
public:
|
|
|
|
|
|
|
|
enum benewake_model_type {
|
|
|
|
BENEWAKE_TF02 = 0,
|
2019-10-14 06:30:48 -03:00
|
|
|
BENEWAKE_TFmini = 1,
|
|
|
|
BENEWAKE_TF03 = 2,
|
2018-05-25 22:59:36 -03:00
|
|
|
};
|
|
|
|
|
|
|
|
// constructor
|
|
|
|
AP_RangeFinder_Benewake(RangeFinder::RangeFinder_State &_state,
|
2018-07-04 11:22:17 -03:00
|
|
|
AP_RangeFinder_Params &_params,
|
2018-05-25 22:59:36 -03:00
|
|
|
uint8_t serial_instance,
|
|
|
|
benewake_model_type model);
|
|
|
|
|
|
|
|
// static detection function
|
2019-07-09 03:14:52 -03:00
|
|
|
static bool detect(uint8_t serial_instance);
|
2018-05-25 22:59:36 -03:00
|
|
|
|
|
|
|
// update state
|
2018-11-07 07:01:51 -04:00
|
|
|
void update(void) override;
|
2018-05-25 22:59:36 -03:00
|
|
|
|
|
|
|
protected:
|
|
|
|
|
|
|
|
virtual MAV_DISTANCE_SENSOR _get_mav_distance_sensor_type() const override {
|
|
|
|
return MAV_DISTANCE_SENSOR_LASER;
|
|
|
|
}
|
|
|
|
|
|
|
|
private:
|
|
|
|
|
|
|
|
// get a reading
|
2018-11-07 21:04:03 -04:00
|
|
|
// distance returned in reading_cm
|
|
|
|
bool get_reading(uint16_t &reading_cm);
|
2018-05-25 22:59:36 -03:00
|
|
|
|
|
|
|
AP_HAL::UARTDriver *uart = nullptr;
|
|
|
|
benewake_model_type model_type;
|
2018-11-18 21:31:24 -04:00
|
|
|
uint8_t linebuf[10];
|
2018-05-25 22:59:36 -03:00
|
|
|
uint8_t linebuf_len;
|
|
|
|
};
|