From 318609bf59083e4247dfd179a3bb36dc2eb9fb45 Mon Sep 17 00:00:00 2001
From: Andrew Tridgell <tridge@samba.org>
Date: Sun, 6 Jan 2013 06:31:37 +1100
Subject: fixed PWM_SERVO_GET

this was using the wrong channel
---
 apps/drivers/px4fmu/fmu.cpp | 2 +-
 1 file changed, 1 insertion(+), 1 deletion(-)

(limited to 'apps/drivers')

diff --git a/apps/drivers/px4fmu/fmu.cpp b/apps/drivers/px4fmu/fmu.cpp
index d5f4123c2..7e78cb979 100644
--- a/apps/drivers/px4fmu/fmu.cpp
+++ b/apps/drivers/px4fmu/fmu.cpp
@@ -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;
 		}
-- 
cgit v1.2.3