void setServo(GT.Interfaces.PWMOutput servo, UInt32 position) { if (position < 1) position = 1; else if (position > 100) position = 100; UInt32 pulse = (MAX_TIME - MIN_TIME) * position / 100; servo.Active = true; servo.SetPulse(PERIOD, pulse); Debug.Print("Position: " + position + " % - Pulselength: " + pulse + "ns"); servo.Active = false; }
private void Servo(GT.Interfaces.PWMOutput pwm, int pwmPulseHighTime) { pwm.SetPulse(_pwmPulsePeriod, (uint)pwmPulseHighTime * 1000); }