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();
}
public PoseCalculatorTest()
{
config = new ArmConfig();
calc = new PoseCalculator(config);
}