AP_Mount: fix siyi version display

This commit is contained in:
Randy Mackay 2022-11-29 13:40:16 +09:00 committed by Andrew Tridgell
parent 8e05c70ec1
commit 17e949eedb
1 changed files with 9 additions and 9 deletions

View File

@ -299,23 +299,23 @@ void AP_Mount_Siyi::process_packet()
// display camera firmware version // display camera firmware version
debug("Mount: SiyiCam fw:%u.%u.%u", debug("Mount: SiyiCam fw:%u.%u.%u",
(unsigned)_msg_buff[_msg_buff_data_start+1], // firmware major version (unsigned)_msg_buff[_msg_buff_data_start+2], // firmware major version
(unsigned)_msg_buff[_msg_buff_data_start+2], // firmware minor version (unsigned)_msg_buff[_msg_buff_data_start+1], // firmware minor version
(unsigned)_msg_buff[_msg_buff_data_start+3]); // firmware revision (unsigned)_msg_buff[_msg_buff_data_start+0]); // firmware revision
// display gimbal info to user // display gimbal info to user
gcs().send_text(MAV_SEVERITY_INFO, "Mount: Siyi fw:%u.%u.%u", gcs().send_text(MAV_SEVERITY_INFO, "Mount: Siyi fw:%u.%u.%u",
(unsigned)_msg_buff[_msg_buff_data_start+5], // firmware major version (unsigned)_msg_buff[_msg_buff_data_start+6], // firmware major version
(unsigned)_msg_buff[_msg_buff_data_start+6], // firmware minor version (unsigned)_msg_buff[_msg_buff_data_start+5], // firmware minor version
(unsigned)_msg_buff[_msg_buff_data_start+7]); // firmware revision (unsigned)_msg_buff[_msg_buff_data_start+4]); // firmware revision
// display zoom firmware version // display zoom firmware version
#if AP_MOUNT_SIYI_DEBUG #if AP_MOUNT_SIYI_DEBUG
if (_parsed_msg.data_bytes_received >= 12) { if (_parsed_msg.data_bytes_received >= 12) {
debug("Mount: SiyiZoom fw:%u.%u.%u", debug("Mount: SiyiZoom fw:%u.%u.%u",
(unsigned)_msg_buff[_msg_buff_data_start+9], // firmware major version (unsigned)_msg_buff[_msg_buff_data_start+10], // firmware major version
(unsigned)_msg_buff[_msg_buff_data_start+10], // firmware minor version (unsigned)_msg_buff[_msg_buff_data_start+9], // firmware minor version
(unsigned)_msg_buff[_msg_buff_data_start+11]); // firmware revision (unsigned)_msg_buff[_msg_buff_data_start+8]); // firmware revision
} }
#endif #endif
break; break;