2024-03-15 18:48:14 -03:00
|
|
|
#pragma once
|
|
|
|
|
|
|
|
#include "AP_RangeFinder_config.h"
|
|
|
|
|
|
|
|
/*
|
|
|
|
questions:
|
|
|
|
- bug on page 22 on malfunction codes
|
|
|
|
- fixed length seems strange at 28 bytes
|
|
|
|
- definition of snr field is missing in documentation
|
|
|
|
- roll/pitch limits are in conflict, 3.2 vs
|
|
|
|
*/
|
|
|
|
#if AP_RANGEFINDER_AINSTEIN_LR_D1_ENABLED
|
|
|
|
|
|
|
|
#include "AP_RangeFinder.h"
|
|
|
|
#include "AP_RangeFinder_Backend_Serial.h"
|
|
|
|
|
|
|
|
class AP_RangeFinder_Ainstein_LR_D1 : public AP_RangeFinder_Backend_Serial
|
|
|
|
{
|
|
|
|
|
|
|
|
public:
|
|
|
|
|
|
|
|
static AP_RangeFinder_Backend_Serial *create(
|
|
|
|
RangeFinder::RangeFinder_State &_state,
|
|
|
|
AP_RangeFinder_Params &_params) {
|
|
|
|
return new AP_RangeFinder_Ainstein_LR_D1(_state, _params);
|
|
|
|
}
|
|
|
|
|
|
|
|
protected:
|
|
|
|
|
|
|
|
MAV_DISTANCE_SENSOR _get_mav_distance_sensor_type() const override {
|
|
|
|
return MAV_DISTANCE_SENSOR_RADAR;
|
|
|
|
}
|
|
|
|
|
|
|
|
uint32_t initial_baudrate(uint8_t serial_instance) const override {
|
|
|
|
return 115200;
|
|
|
|
}
|
|
|
|
|
|
|
|
private:
|
|
|
|
|
|
|
|
using AP_RangeFinder_Backend_Serial::AP_RangeFinder_Backend_Serial;
|
|
|
|
|
|
|
|
// get a reading
|
|
|
|
bool get_reading(float &reading_m) override;
|
|
|
|
|
|
|
|
// 0 is no return value, 100 is perfect. false means signal
|
|
|
|
// quality is not available
|
|
|
|
int8_t get_signal_quality_pct() const override { return signal_quality_pct; };
|
|
|
|
|
|
|
|
static void report_malfunction(const uint8_t _malfunction_alert_);
|
|
|
|
|
|
|
|
enum class MalfunctionAlert : uint8_t {
|
|
|
|
Temperature = (1U << 0), // 0x01
|
|
|
|
Voltage = (1U << 1), // 0x02
|
|
|
|
IFSignalSaturation= (1U << 6), // 0x40
|
|
|
|
AltitudeReading = (1U << 7), // 0x80
|
|
|
|
};
|
|
|
|
|
|
|
|
static constexpr uint8_t PACKET_SIZE = 32;
|
|
|
|
uint8_t malfunction_alert_prev;
|
2024-03-15 19:00:58 -03:00
|
|
|
uint32_t malfunction_alert_last_send_ms;
|
2024-03-15 18:48:14 -03:00
|
|
|
int8_t signal_quality_pct = RangeFinder::SIGNAL_QUALITY_UNKNOWN;
|
|
|
|
};
|
|
|
|
#endif
|