示例#1
0
        private static void TestBorg(ThunderBorg_class myBorg, Logger_class log)
        {
            myBorg.SetLEDBatteryMonitor(false, log);

            myBorg.SetMotorA(128, log);
            System.Threading.Thread.Sleep(1000);
            int getx = myBorg.GetMotorA(log);

            log.WriteLog("Reporting speed A: " + getx.ToString());
            myBorg.GetDriveFaultA(log);

            myBorg.AllStop(log);

            myBorg.SetMotorB(128, log);
            System.Threading.Thread.Sleep(1000);
            int gety = myBorg.GetMotorB(log);

            log.WriteLog("Reporting speed B: " + gety.ToString());
            myBorg.GetDriveFaultB(log);

            myBorg.AllStop(log);

            myBorg.SetMotorA(-128, log);
            System.Threading.Thread.Sleep(1000);
            getx = myBorg.GetMotorA(log);
            log.WriteLog("Reporting speed A: " + getx.ToString());
            myBorg.GetDriveFaultA(log);

            myBorg.AllStop(log);

            myBorg.SetMotorB(-128, log);
            System.Threading.Thread.Sleep(1000);
            gety = myBorg.GetMotorB(log);
            log.WriteLog("Reporting speed B: " + gety.ToString());
            myBorg.GetDriveFaultB(log);

            myBorg.AllStop(log);

            myBorg.SetAllMotors(128, log);
            System.Threading.Thread.Sleep(1000);
            myBorg.AllStop();

            myBorg.SetAllMotors(-128, log);
            System.Threading.Thread.Sleep(1000);
            myBorg.AllStop();

            myBorg.GetFailsafe(log);
            myBorg.SetFailsafe(true, log);
            myBorg.SetFailsafe(true, log);
            myBorg.SetFailsafe(false, log);
            myBorg.SetFailsafe(false, log);

            myBorg.GetLED1(log);
            myBorg.GetLED2(log);

            myBorg.GetLEDBatteryMonitor(log);
            myBorg.SetLEDBatteryMonitor(false, log);
            myBorg.GetLEDBatteryMonitor(log);

            myBorg.SetLED1(255, 255, 255, log);
            myBorg.SetLED2(255, 255, 255, log);
            System.Threading.Thread.Sleep(1000);

            myBorg.SetLEDs(0, 0, 0, log);

            log.WriteLog("Battery voltage: " + myBorg.GetBatteryVoltage(log).ToString());

            myBorg.SetLEDBatteryMonitor(true, log);
            log.WriteLog("Board ID: 0x" + myBorg.GetBoardID(log).ToString("X2"));
            myBorg.GetBatteryMonitoringLimits(log);

            myBorg.SetBatteryMonitoringLimits(7.0M, 35.0M, log);
        }