1
0
mirror of synced 2024-11-30 16:24:27 +01:00

bpreader: it's ugly but it passes the check for pokken

This commit is contained in:
Kevin Trocolli 2023-03-20 03:33:46 -04:00
parent 7223aa6181
commit cfde84b00b

View File

@ -83,8 +83,7 @@ static HRESULT bp_handle_irp_locked(struct irp *irp)
{ {
HRESULT hr; HRESULT hr;
if (irp->op == IRP_OP_OPEN) { if (irp->op == IRP_OP_OPEN) {
dprintf("BNG Reader: Starting backend\n"); dprintf("Reader: Starting backend\n");
dprintf("Reader: Baudrate %ld\n", bp_uart.baud.BaudRate);
} }
hr = uart_handle_irp(&bp_uart, irp); hr = uart_handle_irp(&bp_uart, irp);
@ -96,10 +95,6 @@ static HRESULT bp_handle_irp_locked(struct irp *irp)
dprintf("WRITE:\n"); dprintf("WRITE:\n");
dump_iobuf(&bp_uart.written); dump_iobuf(&bp_uart.written);
} }
if (irp->op == IRP_OP_READ) {
dprintf("READ:\n");
dump_iobuf(&bp_uart.readable);
}
#endif #endif
if (irp->op == IRP_OP_WRITE) { if (irp->op == IRP_OP_WRITE) {
write_ct = 0; write_ct = 0;
@ -114,34 +109,70 @@ static HRESULT bp_handle_irp_locked(struct irp *irp)
} }
else { else {
last_cmd = bp_uart.written.bytes[3]; last_cmd = bp_uart.written.bytes[3];
dump_iobuf(&bp_uart.written); dprintf("Reader: Wrote Cmd %X\n", last_cmd);
return hr; return hr;
} }
} }
if (irp->op == IRP_OP_READ) { if (irp->op == IRP_OP_READ) {
dprintf("Reader: last_cmd %d write_ct %d\n", last_cmd, write_ct); dprintf("Reader: last_cmd %02X write_ct %d\n", last_cmd, write_ct);
switch (last_cmd) { switch (last_cmd) {
case 0x02:
dprintf("Reader: Unknown 0x02\n");
if (!write_ct) {
uint8_t buff[] = { 0x00, 0x00, 0xff, 0x00, 0xff, 0x00, 0x00, 0x00, 0xff, 0x05,
0xfb, 0xd5, 0x0d, 0x00, 0x06, 0x00, 0x18, 0x00 };
hr = iobuf_write(&bp_uart.readable, buff, sizeof(buff));
}
bp_uart.written.pos = 0;
break;
case 0x03: case 0x03:
dprintf("Reader: Initalize Reader\n"); if (!write_ct) {
uint8_t buff_init[] = { 00, 00, 0xFF, 00, 0xFF, 00, 00, 00, 0xFF, 0x02, 0xFE, 0xD5, 0x19, 0x12, 0x00}; dprintf("Reader: Initalize Reader\n");
iobuf_write(&bp_uart.readable, buff_init, sizeof(buff_init)); uint8_t buff[] = { 0x00, 0x00, 0xFF, 0x00, 0xFF, 0x00, 0x00, 0x00, 0xFF, 0x02,
0xFE, 0xD5, 0x19, 0x12, 0x00 };
hr = iobuf_write(&bp_uart.readable, buff, sizeof(buff));
}
bp_uart.written.pos = 0; bp_uart.written.pos = 0;
break; break;
case 0x04:
case 0x06: case 0x06:
dprintf("Reader: Unknown 0x06\n"); if (!write_ct && bp_uart.written.bytes[6] == 0x0e && last_cmd == 0x04) {
uint8_t buff_unk6_r1[] = { 0x00, 0x00, 0xFF, 0x00, 0xFF, 0x00, 0x00, 0x00 }; dprintf("Reader: Unknown second 0x04\n");
uint8_t buff_unk6_r2[] = { 0xFF, 0x02, 0xFE, 0xD5, 0x33, 0xF8, 0x00 }; uint8_t buff[] = { 0x00, 0x00, 0xFF, 0x00, 0xFF, 0x00, 0x00, 0x00, 0xFF, 0x02,
0xFE, 0xD5, 0x0F, 0x1C, 0x00 };
if (!write_ct) { hr = iobuf_write(&bp_uart.readable, buff, sizeof(buff));
dprintf("Reader: Unknown 0x06 first write\n");
iobuf_write(&bp_uart.readable, buff_unk6_r1, sizeof(buff_unk6_r1));
} }
else { else if (!write_ct) {
dprintf("Reader: Unknown 0x06 other write\n"); dprintf("Reader: Unknown 0x06/0x04\n");
iobuf_write(&bp_uart.readable, buff_unk6_r2, sizeof(buff_unk6_r2)); uint8_t buff[] = { 0x00, 0x00, 0xFF, 0x00, 0xFF, 0x00, 0x00, 0x00, 0xFF, 0x02,
0xFE, 0xD5, 0x33, 0xF8, 0x00 };
hr = iobuf_write(&bp_uart.readable, buff, sizeof(buff));
} }
bp_uart.written.pos = 0;
break;
case 0x05:
if (!write_ct) {
dprintf("Reader: Unknown 0x05\n");
uint8_t buff[] = { 0x00, 0x00, 0xFF, 0x00, 0xFF, 0x00, 0x00, 0x00, 0xFF, 0x03,
0xFD, 0xD5, 0x09, 0x00, 0x22, 0x00 };
hr = iobuf_write(&bp_uart.readable, buff, sizeof(buff));
}
bp_uart.written.pos = 0;
break;
case 0x12:
if (!write_ct) {
dprintf("Reader: Unknown 0x12\n");
uint8_t buff[] = { 0x00, 0x00, 0xFF, 0x00, 0xFF, 0x00, 0x00, 0x00, 0xFF, 0x0a,
0xf6, 0xd5, 0x07, 0xff, 0x3f, 0x0e, 0xf1, 0xff, 0x3f, 0x0e, 0xf1, 0xaa, 0x00 };
hr = iobuf_write(&bp_uart.readable, buff, sizeof(buff));
}
bp_uart.written.pos = 0;
break; break;
default: default:
@ -151,7 +182,18 @@ static HRESULT bp_handle_irp_locked(struct irp *irp)
} }
write_ct++; write_ct++;
} }
if (FAILED(hr)) {
dprintf("Reader: HR failed %lX", hr);
}
#if 0
if (irp->op == IRP_OP_READ) {
dprintf("READ:\n");
dump_iobuf(&bp_uart.readable);
}
#endif
bp_uart.written.pos = 0; bp_uart.written.pos = 0; // consume the written buffer
return hr; return hr;
} }