Skip to content
Snippets Groups Projects
Unverified Commit ef07aecf authored by Gus Grubba's avatar Gus Grubba Committed by GitHub
Browse files

Merge pull request #7998 from mavlink/pr-fix-camera-battery

We can only filter by component ID
parents aa7a4582 e8618672
No related branches found
No related tags found
No related merge requests found
...@@ -68,7 +68,8 @@ QGCCameraManager::_vehicleReady(bool ready) ...@@ -68,7 +68,8 @@ QGCCameraManager::_vehicleReady(bool ready)
void void
QGCCameraManager::_mavlinkMessageReceived(const mavlink_message_t& message) QGCCameraManager::_mavlinkMessageReceived(const mavlink_message_t& message)
{ {
if(message.sysid == _vehicle->id()) { //-- Only pay attention to camera components, as identified by their compId
if(message.sysid == _vehicle->id() && (message.compid >= MAV_COMP_ID_CAMERA && message.compid <= MAV_COMP_ID_CAMERA6)) {
switch (message.msgid) { switch (message.msgid) {
case MAVLINK_MSG_ID_CAMERA_CAPTURE_STATUS: case MAVLINK_MSG_ID_CAMERA_CAPTURE_STATUS:
_handleCaptureStatus(message); _handleCaptureStatus(message);
...@@ -110,10 +111,6 @@ QGCCameraManager::_handleHeartbeat(const mavlink_message_t &message) ...@@ -110,10 +111,6 @@ QGCCameraManager::_handleHeartbeat(const mavlink_message_t &message)
{ {
mavlink_heartbeat_t heartbeat; mavlink_heartbeat_t heartbeat;
mavlink_msg_heartbeat_decode(&message, &heartbeat); mavlink_msg_heartbeat_decode(&message, &heartbeat);
//-- Only pay attention to camera components, as identified by their MAV_TYPE, and as fallback by their compId
if(_vehicleReadyState && _vehicle->id() == message.sysid &&
((heartbeat.autopilot == MAV_AUTOPILOT_INVALID && heartbeat.type == MAV_TYPE_CAMERA) ||
(message.compid >= MAV_COMP_ID_CAMERA && message.compid <= MAV_COMP_ID_CAMERA6))) {
//-- First time hearing from this one? //-- First time hearing from this one?
QString sCompID = QString::number(message.compid); QString sCompID = QString::number(message.compid);
if(!_cameraInfoRequest.contains(sCompID)) { if(!_cameraInfoRequest.contains(sCompID)) {
...@@ -150,7 +147,6 @@ QGCCameraManager::_handleHeartbeat(const mavlink_message_t &message) ...@@ -150,7 +147,6 @@ QGCCameraManager::_handleHeartbeat(const mavlink_message_t &message)
} }
} }
} }
}
//----------------------------------------------------------------------------- //-----------------------------------------------------------------------------
QGCCameraControl* QGCCameraControl*
......
0% Loading or .
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment