AP_Mount: fix handle_command_do_mount_configure instance handling

This commit is contained in:
Randy Mackay 2022-06-20 19:54:17 +09:00
parent e58d72931e
commit 898bdb864c

View File

@ -609,9 +609,9 @@ MAV_RESULT AP_Mount::handle_command_do_mount_configure(const mavlink_command_lon
return MAV_RESULT_FAILED; return MAV_RESULT_FAILED;
} }
_backends[_primary]->set_mode((MAV_MOUNT_MODE)packet.param1); _backends[_primary]->set_mode((MAV_MOUNT_MODE)packet.param1);
state[0]._stab_roll = packet.param2; state[_primary]._stab_roll = packet.param2;
state[0]._stab_tilt = packet.param3; state[_primary]._stab_tilt = packet.param3;
state[0]._stab_pan = packet.param4; state[_primary]._stab_pan = packet.param4;
return MAV_RESULT_ACCEPTED; return MAV_RESULT_ACCEPTED;
} }