Max/djhackersdev_bemanitools
1
0
Fork 0
Code Issues 72 Pull Requests 15 Actions Packages Projects Releases 20 Wiki Activity

aciodrv: Update aciodrv_device_init to properly reset the device

Browse Source
This commit is contained in:
Will Xyen
2021-05-01 10:30:02 -07:00
parent 7c43fb7163
commit d529ee484f
1 changed files with 21 additions and 3 deletions
Download Patch File Download Diff File Expand all files Collapse all files
src/main/aciodrv/device.c
+21 -3
View File
@@ -25,10 +25,28 @@ struct aciodrv_device_ctx {
static bool aciodrv_device_init(struct aciodrv_device_ctx *device) static bool aciodrv_device_init(struct aciodrv_device_ctx *device)
{ {
uint8_t reset_seq[525] = {0};
uint8_t init_seq[1] = {AC_IO_SOF}; uint8_t init_seq[1] = {AC_IO_SOF};
uint8_t read_buff[1] = {0x00}; uint8_t read_buff[1] = {0};
/* init/reset the device by sending 0xAA until 0xAA is returned */ /* init/reset the device by sending 525 NULL bytes */
log_info("Resetting device");
if (aciodrv_port_write(device->fd, reset_seq, sizeof(reset_seq)) <= 0) {
return false;
}
/* signal to device for a reset */
EscapeCommFunction(device->fd, SETBREAK);
Sleep(1450);
EscapeCommFunction(device->fd, CLRBREAK);
Sleep(1200);
/* ignore the next 100 reads (of whatever length) */
for (size_t i = 0; i < 100; ++i) {
aciodrv_port_read(device->fd, reset_seq, sizeof(reset_seq));
}
/* wait for reset to finish */
int read = 0; int read = 0;
do { do {
if (aciodrv_port_write(device->fd, init_seq, sizeof(init_seq)) <= 0) { if (aciodrv_port_write(device->fd, init_seq, sizeof(init_seq)) <= 0) {
@@ -39,7 +57,7 @@ static bool aciodrv_device_init(struct aciodrv_device_ctx *device)
} while ((read <= 0) || (read_buff[0] != init_seq[0])); } while ((read <= 0) || (read_buff[0] != init_seq[0]));
if (read > 0) { if (read > 0) {
log_warning("Obtained SOF, clearing out buffer now"); log_info("Obtained SOF, clearing out buffer now");
/* empty buffer by reading all data */ /* empty buffer by reading all data */
while (read > 0) { while (read > 0) {
read = aciodrv_port_read(device->fd, init_seq, sizeof(init_seq)); read = aciodrv_port_read(device->fd, init_seq, sizeof(init_seq));