|
|
@ -14,33 +14,33 @@ class AC_PrecLand_Companion : public AC_PrecLand_Backend |
|
|
|
public: |
|
|
|
public: |
|
|
|
// Constructor
|
|
|
|
// Constructor
|
|
|
|
AC_PrecLand_Companion(const AC_PrecLand& frontend, AC_PrecLand::precland_state& state); |
|
|
|
AC_PrecLand_Companion(const AC_PrecLand& frontend, AC_PrecLand::precland_state& state); |
|
|
|
|
|
|
|
|
|
|
|
// perform any required initialisation of backend
|
|
|
|
// perform any required initialisation of backend
|
|
|
|
void init(); |
|
|
|
void init() override; |
|
|
|
|
|
|
|
|
|
|
|
// retrieve updates from sensor
|
|
|
|
// retrieve updates from sensor
|
|
|
|
void update(); |
|
|
|
void update() override; |
|
|
|
|
|
|
|
|
|
|
|
// provides a unit vector towards the target in body frame
|
|
|
|
// provides a unit vector towards the target in body frame
|
|
|
|
// returns same as have_los_meas()
|
|
|
|
// returns same as have_los_meas()
|
|
|
|
bool get_los_body(Vector3f& ret); |
|
|
|
bool get_los_body(Vector3f& ret) override; |
|
|
|
|
|
|
|
|
|
|
|
// returns system time in milliseconds of last los measurement
|
|
|
|
// returns system time in milliseconds of last los measurement
|
|
|
|
uint32_t los_meas_time_ms(); |
|
|
|
uint32_t los_meas_time_ms() override; |
|
|
|
|
|
|
|
|
|
|
|
// return true if there is a valid los measurement available
|
|
|
|
// return true if there is a valid los measurement available
|
|
|
|
bool have_los_meas(); |
|
|
|
bool have_los_meas() override; |
|
|
|
|
|
|
|
|
|
|
|
// returns distance to target in meters (0 means distance is not known)
|
|
|
|
// returns distance to target in meters (0 means distance is not known)
|
|
|
|
float distance_to_target() override; |
|
|
|
float distance_to_target() override; |
|
|
|
|
|
|
|
|
|
|
|
// parses a mavlink message from the companion computer
|
|
|
|
// parses a mavlink message from the companion computer
|
|
|
|
void handle_msg(mavlink_message_t* msg); |
|
|
|
void handle_msg(mavlink_message_t* msg) override; |
|
|
|
|
|
|
|
|
|
|
|
private: |
|
|
|
private: |
|
|
|
uint64_t _timestamp_us; // timestamp from message
|
|
|
|
uint64_t _timestamp_us; // timestamp from message
|
|
|
|
float _distance_to_target; // distance from the camera to target in meters
|
|
|
|
float _distance_to_target; // distance from the camera to target in meters
|
|
|
|
|
|
|
|
|
|
|
|
Vector3f _los_meas_body; // unit vector in body frame pointing towards target
|
|
|
|
Vector3f _los_meas_body; // unit vector in body frame pointing towards target
|
|
|
|
bool _have_los_meas; // true if there is a valid measurement from the camera
|
|
|
|
bool _have_los_meas; // true if there is a valid measurement from the camera
|
|
|
|
uint32_t _los_meas_time_ms; // system time in milliseconds when los was measured
|
|
|
|
uint32_t _los_meas_time_ms; // system time in milliseconds when los was measured
|
|
|
|