Mirror/ardupilot
5
0
Fork 0
mirror of https://github.com/ArduPilot/ardupilot synced 2025-02-22 07:44:03 -04:00
Code Issues Packages Projects Releases Wiki Activity

Mount_MAVLink: uses vehicle's sysid

Browse Source
This commit is contained in:
Randy Mackay 2015-04-20 15:59:49 +09:00
parent e726a05f3b
commit 93ba2d2d32
3 changed files with 3 additions and 5 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

2
libraries/AP_Mount/AP_Gimbal.cpp
View File

@ -164,7 +164,7 @@ Vector3f AP_Gimbal::getGimbalRateDemVecGyroBias()
void AP_Gimbal::send_control(mavlink_channel_t chan)
{
mavlink_msg_gimbal_control_send(chan,_sysid, _compid,
mavlink_msg_gimbal_control_send(chan, mavlink_system.sysid, _compid,
gimbalRateDemVec.x, gimbalRateDemVec.y, gimbalRateDemVec.z);
}

4
libraries/AP_Mount/AP_Gimbal.h
View File

@ -23,7 +23,7 @@ class AP_Gimbal
{
public:
//Constructor
AP_Gimbal(const AP_AHRS_NavEKF &ahrs, uint8_t sysid, uint8_t compid, const AP_Mount::gimbal_params &gimbalParams) :
AP_Gimbal(const AP_AHRS_NavEKF &ahrs, uint8_t compid, const AP_Mount::gimbal_params &gimbalParams) :
_ekf(ahrs),
_ahrs(ahrs),
_gimbalParams(gimbalParams),
@ -31,7 +31,6 @@ public:
yawRateFiltPole(10.0f),
yawErrorLimit(0.1f)
{
_sysid = sysid;
_compid = compid;
}
@ -68,7 +67,6 @@ private:
// reducing this makes the gimbal respond more to vehicle yaw disturbances
float const yawErrorLimit;
uint8_t _sysid;
uint8_t _compid;
void send_control(mavlink_channel_t chan);

2
libraries/AP_Mount/AP_Mount_MAVLink.cpp
View File

@ -13,7 +13,7 @@
AP_Mount_MAVLink::AP_Mount_MAVLink(AP_Mount &frontend, AP_Mount::mount_state &state, uint8_t instance) :
AP_Mount_Backend(frontend, state, instance),
_initialised(false),
_gimbal(frontend._ahrs, 1, MAV_COMP_ID_GIMBAL, _state._gimbalParams)
_gimbal(frontend._ahrs, MAV_COMP_ID_GIMBAL, _state._gimbalParams)
{}
// init - performs any required initialisation for this instance