|
|
|
@ -496,6 +496,9 @@ Navigator::run()
@@ -496,6 +496,9 @@ Navigator::run()
|
|
|
|
|
|
|
|
|
|
case vehicle_command_s::VEHICLE_CMD_DO_SET_ROI_LOCATION: |
|
|
|
|
_vroi.mode = vehicle_command_s::VEHICLE_ROI_LOCATION; |
|
|
|
|
_vroi.lat = cmd.param5; |
|
|
|
|
_vroi.lon = cmd.param6; |
|
|
|
|
_vroi.alt = cmd.param7; |
|
|
|
|
break; |
|
|
|
|
|
|
|
|
|
case vehicle_command_s::VEHICLE_CMD_DO_SET_ROI_WPNEXT_OFFSET: |
|
|
|
@ -508,29 +511,6 @@ Navigator::run()
@@ -508,29 +511,6 @@ Navigator::run()
|
|
|
|
|
case vehicle_command_s::VEHICLE_CMD_DO_SET_ROI_NONE: |
|
|
|
|
_vroi.mode = vehicle_command_s::VEHICLE_ROI_NONE; |
|
|
|
|
break; |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
switch (_vroi.mode) { |
|
|
|
|
case vehicle_command_s::VEHICLE_ROI_NONE: |
|
|
|
|
break; |
|
|
|
|
|
|
|
|
|
case vehicle_command_s::VEHICLE_ROI_WPNEXT: |
|
|
|
|
// TODO: implement point toward next MISSION
|
|
|
|
|
break; |
|
|
|
|
|
|
|
|
|
case vehicle_command_s::VEHICLE_ROI_WPINDEX: |
|
|
|
|
_vroi.mission_seq = cmd.param2; |
|
|
|
|
break; |
|
|
|
|
|
|
|
|
|
case vehicle_command_s::VEHICLE_ROI_LOCATION: |
|
|
|
|
_vroi.lat = cmd.param5; |
|
|
|
|
_vroi.lon = cmd.param6; |
|
|
|
|
_vroi.alt = cmd.param7; |
|
|
|
|
break; |
|
|
|
|
|
|
|
|
|
case vehicle_command_s::VEHICLE_ROI_TARGET: |
|
|
|
|
_vroi.target_seq = cmd.param2; |
|
|
|
|
break; |
|
|
|
|
|
|
|
|
|
default: |
|
|
|
|
_vroi.mode = vehicle_command_s::VEHICLE_ROI_NONE; |
|
|
|
|