internal static Waypoint Create(UasMissionItemInt rec)
{
var wp = new Waypoint()
{
Sequence = rec.Seq,
Frame = (MavFrame)rec.Frame,
X = rec.Y.ToLatLon(), // From Mav Link Lon comes on Y
Y = rec.X.ToLatLon(), // From Mav Link Lat comes in X
Z = rec.Z,
Param1 = rec.Param1,
Param2 = rec.Param2,
Param3 = rec.Param3,
Param4 = rec.Param4,
Command = (MavCmd)rec.Command,
Current = rec.Current
};
return(wp);
}
private void button12_Click(object sender, EventArgs e)
{
var msg = new UasMissionCount {
Count = 2
};
_mMavLink.SendMessage(msg);
Thread.Sleep(500);
var msg1 = new UasMissionItemInt
{
Seq = 0,
Command = MavCmd.NavWaypoint,
X = 7900004,
Y = 3400004,
Frame = MavFrame.GlobalRelativeAlt
};
_mMavLink.SendMessage(msg1);
Thread.Sleep(500);
var msg2 = new UasMissionItemInt
{
Seq = 1,
Command = MavCmd.NavTakeoff,
X = 7900005,
Y = 3400005,
Frame = MavFrame.GlobalRelativeAlt
};
_mMavLink.SendMessage(msg2);
Thread.Sleep(500);
//msg2 = new UasMissionItem
//{
// Seq = 2,
// Command = MavCmd.NavWaypoint,
// X = 79.0002f,
// Y = 34.0002f
//};
//_mMavLink.SendMessage(msg2);
}
