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);
}
