From 19b2e1de8505be6ab23bedab7b105a20ac7af405 Mon Sep 17 00:00:00 2001
From: px4dev <px4@purgatory.org>
Date: Sat, 6 Jul 2013 00:00:44 -0700
Subject: [PATCH] Copy the correct number of bytes back for register read
 operations. Basic PX4IO comms are working now.

---
 src/modules/px4iofirmware/serial.c | 2 +-
 1 file changed, 1 insertion(+), 1 deletion(-)

diff --git a/src/modules/px4iofirmware/serial.c b/src/modules/px4iofirmware/serial.c
index b918193738..f19021d8c9 100644
--- a/src/modules/px4iofirmware/serial.c
+++ b/src/modules/px4iofirmware/serial.c
@@ -233,7 +233,7 @@ rx_handle_packet(void)
 				count = PKT_COUNT(dma_packet);
 
 			/* copy reply registers into DMA buffer */
-			memcpy((void *)&dma_packet.regs[0], registers, count);
+			memcpy((void *)&dma_packet.regs[0], registers, count * 2);
 			dma_packet.count_code = count | PKT_CODE_SUCCESS;
 		}
 		return;