From 72fcc8aad32936692814f4e9521a462bedc6c723 Mon Sep 17 00:00:00 2001
From: px4dev <px4@purgatory.org>
Date: Sat, 26 Jan 2013 13:15:27 -0800
Subject: [PATCH] Tidy up the write path.

---
 apps/drivers/px4io/px4io.cpp | 12 +++++-------
 1 file changed, 5 insertions(+), 7 deletions(-)

diff --git a/apps/drivers/px4io/px4io.cpp b/apps/drivers/px4io/px4io.cpp
index 257b15685c..769363b4a8 100644
--- a/apps/drivers/px4io/px4io.cpp
+++ b/apps/drivers/px4io/px4io.cpp
@@ -1085,18 +1085,16 @@ ssize_t
 PX4IO::write(file *filp, const char *buffer, size_t len)
 {
 	unsigned count = len / 2;
-	int ret;
 
-	if (count > 0) {
 		if (count > _max_actuators)
 			count = _max_actuators;
-		ret = io_reg_set(PX4IO_PAGE_DIRECT_PWM, 0, (uint16_t *)buffer, count);
-	} else {
-		ret = -EINVAL;
-	}
-
+	if (count > 0) {
+		int ret = io_reg_set(PX4IO_PAGE_DIRECT_PWM, 0, (uint16_t *)buffer, count);
+		if (ret != OK)
 	return ret;
 }
+	return count * 2;
+}
 
 extern "C" __EXPORT int px4io_main(int argc, char *argv[]);