When i build my MavLinkCommands, i want to do Navigate To waypoint and ROI together, how can i do that?
I try to create a NavigateToWaypoint command with yaw 0 and right after that the ROI command and it doesnt work.
Working on the Android GroundSDK.
I attached an example. Is the order of the commands wrong?
public void SetRoiCommand(double latitude, double longitude, double altitude){
SetRoiCommand setRoiCommand = new SetRoiCommand(
latitude,longitude,altitude
);
commands.add(setRoiCommand);
}
public void WaypointMission(double latitude, double longitude, double altitude, double yaw, double holdTime, double acceptanceRadius) {
// yaw = yaw * (Math.PI );
NavigateToWaypointCommand waypointCommand = new NavigateToWaypointCommand(
latitude,
longitude,
altitude,
yaw,
holdTime,
acceptanceRadius
);
commands.add(waypointCommand);
}
WaypointMission(48.87869311, 2.36843671, 1, -1, 1, 1);
SetRoiCommand(48.87869311,2.36843671,2);
WaypointMission(48.87851177, 2.36781712, 3, -1, 0, 1);