public override void SetCurrentHome()
{
HomePosition = new MavlinkWaypoint();
HomePosition.Latitude = Latitude;
HomePosition.Longitude = Longitude;
HomePosition.Altitude = Altitude;
//HomePosition.Command = Command;
}
public void GotoWaypoint(float Latitude, float longitude, float altitude, float param1, float param2, float param3, float angle)
{
if (VehicleSelected != null)
{
var gotoWaypoint = new MavlinkWaypoint
{
Latitude = Latitude,
Longitude = longitude,
Altitude = altitude,
Id = 0,
Command = (ushort)MAVLink.MAV_CMD.OVERRIDE_GOTO,
Param1 = param1,
Param2 = param2,
Param3 = param3,
Param4 = angle,
};
VehicleComponent.GotoWaypointCommand(VehicleSelected.ID, gotoWaypoint);
}
}
