vmount: implement VEHICLE_CMD_DO_SET_ROI_WPNEXT_OFFSET

This commit is contained in:
Beat Küng
2018-03-19 09:42:41 +01:00
parent cc777a80ff
commit a0372c6183
6 changed files with 19 additions and 10 deletions
+3 -3
View File
@@ -503,9 +503,9 @@ Navigator::run()
case vehicle_command_s::VEHICLE_CMD_DO_SET_ROI_WPNEXT_OFFSET:
_vroi.mode = vehicle_command_s::VEHICLE_ROI_WPNEXT;
_vroi.pitchOffset = cmd.param5;
_vroi.rollOffset = cmd.param6;
_vroi.yawOffset = cmd.param7;
_vroi.pitch_offset = (float)cmd.param5 * M_DEG_TO_RAD_F;
_vroi.roll_offset = (float)cmd.param6 * M_DEG_TO_RAD_F;
_vroi.yaw_offset = (float)cmd.param7 * M_DEG_TO_RAD_F;
break;
case vehicle_command_s::VEHICLE_CMD_DO_SET_ROI_NONE: