From 218ead5fe58c163adc5a05efb2b643d05c25ac48 Mon Sep 17 00:00:00 2001
From: =?UTF-8?q?S=C3=B6ren=20H=C3=B6ckner?= <soeren.hoeckner@tu-cottbus.de>
Date: Tue, 14 Sep 2010 14:52:15 +1200
Subject: [PATCH] fet: fix packet size alignment when reading/writing buffers.

---
 fet.c | 4 ++++
 1 file changed, 4 insertions(+)

diff --git a/fet.c b/fet.c
index 6e83311..ac4e663 100644
--- a/fet.c
+++ b/fet.c
@@ -758,6 +758,8 @@ int fet_readmem(device_t dev_base, address_t addr, uint8_t *buffer,
 	while (count > 1) {
 		int plen = count > 128 ? 128 : count;
 
+		plen &= ~0x1;
+
 		if (xfer(dev, C_READMEMORY, NULL, 0, 2, addr, plen) < 0) {
 			printc_err("fet: failed to read "
 				"from 0x%04x\n", addr);
@@ -799,6 +801,8 @@ int fet_writemem(device_t dev_base, address_t addr,
 		int plen = count > 128 ? 128 : count;
 		int ret;
 
+		plen &= ~0x1;
+
 		ret = xfer(dev, C_WRITEMEMORY, buffer, plen, 1, addr);
 
 		if (ret < 0) {