mirror of https://github.com/ArduPilot/ardupilot
AP_Mount: fix siyi version display
This commit is contained in:
parent
8e05c70ec1
commit
17e949eedb
|
@ -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;
|
||||||
|
|
Loading…
Reference in New Issue