public static void SaveOffsets3(double[] ofs)
{
if (MainV2.comPort.MAV.param.ContainsKey("COMPASS_OFS3_X") && MainV2.comPort.BaseStream.IsOpen)
{
try
{
// disable learning
MainV2.comPort.setParam("COMPASS_LEARN", 0);
{
MainV2.comPort.setParam("COMPASS_OFS3_X", (float)ofs[0]);
MainV2.comPort.setParam("COMPASS_OFS3_Y", (float)ofs[1]);
MainV2.comPort.setParam("COMPASS_OFS3_Z", (float)ofs[2]);
}
if (ofs.Length > 3)
{
// ellipsoid
}
}
catch
{
CustomMessageBox.Show("Setting new offsets for compass #3 failed");
return;
}
CustomMessageBox.Show(
"New offsets for compass #3 are " + ofs[0].ToString("0") + " " + ofs[1].ToString("0") + " " +
ofs[2].ToString("0") + "\nThese have been saved for you.", "New Mag Offsets");
}
else
{
CustomMessageBox.Show(
"New compass3 offsets are " + ofs[0].ToString("0") + " " + ofs[1].ToString("0") + " " +
ofs[2].ToString("0") + "\n\nPlease write these down for manual entry", "New Mag Offsets");
}
}