Commit f5a575966c5971f96600bc8a1320d8eb2253ed9a
2012-12-09T12:06:42
libztex: use a function for the twice called firmware reset code
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29 30 31 32 33 34 35 36 37 38 39 40 41 42 43 44 45 46 47 48 49 50 51 52 53 54 55 56
diff --git a/libztex.c b/libztex.c
index 13965ca..a34227e 100644
--- a/libztex.c
+++ b/libztex.c
@@ -100,6 +100,19 @@ enum check_result
CHECK_RESCAN,
};
+static bool libztex_firmwareReset(struct libusb_device_handle *hndl, bool enable)
+{
+ uint8_t reset = enable;
+ int cnt = libusb_control_transfer(hndl, 0x40, 0xA0, 0xE600, 0, &reset, 1, 1000);
+ if (cnt < 0)
+ {
+ applog(LOG_ERR, "Ztex reset %d failed: %s", libusb_error_name(cnt), enable);
+ return 1;
+ }
+
+ return 0;
+}
+
static enum check_result libztex_checkDevice(struct libusb_device *dev)
{
FILE *fp = NULL;
@@ -245,14 +258,8 @@ static enum check_result libztex_checkDevice(struct libusb_device *dev)
goto done;
}
- // reset 1
- buf[0] = 1;
- cnt = libusb_control_transfer(hndl, 0x40, 0xA0, 0xE600, 0, buf, 1,1000);
- if (cnt < 0)
- {
- applog(LOG_ERR, "Ztex reset 1 failed: %s", libusb_error_name(cnt));
+ if (libztex_firmwareReset(hndl, true))
goto done;
- }
for (i = 0; i < length; i+= 256) {
// firmware wants data in small chunks like 256 bytes
@@ -265,14 +272,8 @@ static enum check_result libztex_checkDevice(struct libusb_device *dev)
}
}
- // reset 0
- buf[0] = 0;
- err = libusb_control_transfer(hndl, 0x40, 0xA0, 0xE600, 0, buf, 1,1000);
- if (err < 0)
- {
- applog(LOG_ERR, "Ztex reset 0 failed: %s", libusb_error_name(err));
+ if (libztex_firmwareReset(hndl, false))
goto done;
- }
applog(LOG_ERR, "Ztex device: succesfully wrote firmware");
ret = CHECK_RESCAN;