private void btnDebug_Click(object sender, EventArgs e)
        {
            AutoPilot mA = new AutoPilot(30.0, 30.0,1000);

            StringBuilder sb = new StringBuilder();
            sb.Append("Target,Current,Diff,Roll\r\n");
            for (double j,i = -3.1; i <= 3.14; i += 0.3)
            {
                for (j = -3.1; j <= 3.14; j += 0.3)
                {
                    mA.CurrentHeading = i;
                    mA.TargetHeading = j;
                    mA.RollToBearingDifference();
                    sb.Append(mA.TargetHeading.ToString());
                    sb.Append(",");
                    sb.Append(mA.CurrentHeading.ToString());
                    sb.Append(",");
                    sb.Append(mA.HeadingDifference.ToString());
                    sb.Append(",");
                    sb.Append(mA.TargetRollAngle.ToString());
                    sb.Append("\r\n");
                }
            }
        }