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); }