FlightData: add set loiter rad #932

ArduPilot · Apr 1, 2016 · ccacc70 · ccacc70
1 parent cb7ebaf
commit ccacc70
Show file tree

Hide file tree

Showing 3 changed files with 793 additions and 1,739 deletions.
diff --git a/GCSViews/FlightData.Designer.cs b/GCSViews/FlightData.Designer.cs
diff --git a/GCSViews/FlightData.cs b/GCSViews/FlightData.cs
@@ -2046,9 +2046,15 @@ private void FlightData_ParentChanged(object sender, EventArgs e)
                      && (float) MainV2.comPort.MAV.param["ARSPD_USE"] == 0)
             {
                 modifyandSetSpeed.Value = (decimal) (float) MainV2.comPort.MAV.param["TRIM_THROTTLE"];
-                    // percent
+                // percent
                 modifyandSetSpeed.ButtonText = Strings.ChangeThrottle;
             }
+
+            if (MainV2.comPort.MAV.param.ContainsKey("LOITER_RAD"))
+                modifyandSetLoiterRad.Value = (decimal) (float) MainV2.comPort.MAV.param["LOITER_RAD"];
+
+            if (MainV2.comPort.MAV.param.ContainsKey("WP_LOITER_RAD"))
+                modifyandSetLoiterRad.Value = (decimal) (float) MainV2.comPort.MAV.param["WP_LOITER_RAD"];
         }
 
         void cam_camimage(Image camimage)
@@ -4118,5 +4124,19 @@ private void PointCameraCoordsToolStripMenuItem1_Click(object sender, EventArgs
                 CustomMessageBox.Show(Strings.InvalidField, Strings.ERROR);
             }
         }
+
+        private void modifyandSetLoiterRad_Click(object sender, EventArgs e)
+        {
+            int newrad = (int)modifyandSetLoiterRad.Value;
+
+            try
+            {
+                MainV2.comPort.setParam(new[] { "LOITER_RAD", "WP_LOITER_RAD" },newrad / CurrentState.multiplierdist);
+            }
+            catch
+            {
+                CustomMessageBox.Show(Strings.ErrorCommunicating, Strings.ERROR);
+            }
+        }
     }
 }