fixed PWM_SERVO_GET

this was using the wrong channel
This commit is contained in:
Andrew Tridgell 2013-01-06 06:31:37 +11:00
parent 0134186420
commit 318609bf59

View File

@ -504,7 +504,7 @@ PX4FMU::pwm_ioctl(file *filp, int cmd, unsigned long arg)
/* FALLTHROUGH */
case PWM_SERVO_GET(0):
case PWM_SERVO_GET(1): {
channel = cmd - PWM_SERVO_SET(0);
channel = cmd - PWM_SERVO_GET(0);
*(servo_position_t *)arg = up_pwm_servo_get(channel);
break;
}