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.
70 lines
2.2 KiB
70 lines
2.2 KiB
// -*- tab-width: 4; Mode: C++; c-basic-offset: 4; indent-tabs-mode: nil -*- |
|
|
|
/* |
|
MAVLink enabled mount backend class |
|
*/ |
|
|
|
#ifndef __AP_MOUNT_MAVLINK_H__ |
|
#define __AP_MOUNT_MAVLINK_H__ |
|
|
|
#include <AP_Math.h> |
|
#include <AP_Common.h> |
|
#include <AP_GPS.h> |
|
#include <AP_AHRS.h> |
|
#include <GCS_MAVLink.h> |
|
#include <RC_Channel.h> |
|
#include <AP_Mount_Backend.h> |
|
|
|
class AP_Mount_MAVLink : public AP_Mount_Backend |
|
{ |
|
|
|
public: |
|
// Constructor |
|
AP_Mount_MAVLink(AP_Mount &frontend, uint8_t instance) : |
|
AP_Mount_Backend(frontend, instance), |
|
_enabled(false), |
|
_chan(MAVLINK_COMM_0), |
|
_sysid(0), |
|
_compid(0) |
|
{} |
|
|
|
// init - performs any required initialisation for this instance |
|
virtual void init(); |
|
|
|
// update mount position - should be called periodically |
|
virtual void update(); |
|
|
|
// has_pan_control - returns true if this mount can control it's pan (required for multicopters) |
|
virtual bool has_pan_control() const; |
|
|
|
// set_mode - sets mount's mode |
|
virtual void set_mode(enum MAV_MOUNT_MODE mode); |
|
|
|
// set_roi_target - sets target location that mount should attempt to point towards |
|
virtual void set_roi_target(const struct Location &target_loc); |
|
|
|
// configure_msg - process MOUNT_CONFIGURE messages received from GCS |
|
virtual void configure_msg(mavlink_message_t* msg); |
|
|
|
// control_msg - process MOUNT_CONTROL messages received from GCS |
|
virtual void control_msg(mavlink_message_t* msg); |
|
|
|
// status_msg - called to allow mounts to send their status to GCS using the MOUNT_STATUS message |
|
virtual void status_msg(mavlink_channel_t chan); |
|
|
|
private: |
|
|
|
// find_mount - search for MAVLink enabled mount |
|
void find_mount(); |
|
|
|
// send_angle_target - send earth-frame angle targets (in degrees) to mount |
|
void send_angle_target(const Vector3f& target_deg); |
|
|
|
// internal variables |
|
bool _enabled; // gimbal becomes enabled once the mount has been discovered |
|
mavlink_channel_t _chan; // telemetry channel used to communicate with mount |
|
uint8_t _sysid; // system id of MAVLink enabled mount |
|
uint8_t _compid; // component id of MAVLink enabled mount |
|
}; |
|
|
|
#endif // __AP_MOUNT_MAVLINK_H__
|
|
|