Exemple #1
0
        public ServoDriver()
        {
            config            = new ArmConfig();
            poseCalculator    = new PoseCalculator(config);
            notifyWorkerEvent = new AutoResetEvent(false);

            //for(int i = 0; i<6; i++)
            //{
            //    servoProgress[i] = 1;
            //    servoToStep[i] = 1;
            //}

            Pi.Init <Unosquare.WiringPi.BootstrapWiringPi>();
            servos = config.CreateSteppers();

            //servos = config.CreateTestServos();

            load();
        }