X-Git-Url: https://git.zerfleddert.de/cgi-bin/gitweb.cgi/hmcfgusb/blobdiff_plain/b55c340d3dbf7b6071d64260a3dc5287c940b984..62f60cc1519f114c5906cafaf49c34dc90729643:/hmland.c diff --git a/hmland.c b/hmland.c index aa5f277..3dae545 100644 --- a/hmland.c +++ b/hmland.c @@ -239,8 +239,13 @@ static int hmlan_format_out(uint8_t *buf, int buf_len, void *data) hexdump(buf, buf_len, "Unknown> "); break; } - if (debug) - fprintf(stderr, "LAN < %s\n", out); + if (verbose) { + int i; + + printf("LAN < "); + for (i = 0; i < outpos-out; i++) + printf("%c", out[i]); + } w = write(fd, out, outpos-out); if (w <= 0) { @@ -270,9 +275,6 @@ static int hmlan_parse_in(int fd, void *data) inpos = buf; - if (debug) - fprintf(stderr, "\nLAN > %s", buf); - while (inpos < inend) { uint8_t *instart = inpos; @@ -295,6 +297,13 @@ static int hmlan_parse_in(int fd, void *data) if (last == 0) continue; + if (verbose) { + printf("LAN > "); + for (i = 0; i < last; i++) + printf("%c", instart[i]); + printf("\n"); + } + memset(out, 0, sizeof(out)); *outpos++ = *inpos++; @@ -307,6 +316,11 @@ static int hmlan_parse_in(int fd, void *data) parse_part_in(&inpos, (last-(inpos-instart)), &outpos, (sizeof(out)-(outpos-out)), 0); parse_part_in(&inpos, (last-(inpos-instart)), &outpos, (sizeof(out)-(outpos-out)), FLAG_LENGTH_BYTE); break; + case 'Y': + parse_part_in(&inpos, (last-(inpos-instart)), &outpos, (sizeof(out)-(outpos-out)), 0); + parse_part_in(&inpos, (last-(inpos-instart)), &outpos, (sizeof(out)-(outpos-out)), 0); + parse_part_in(&inpos, (last-(inpos-instart)), &outpos, (sizeof(out)-(outpos-out)), FLAG_LENGTH_BYTE); + break; default: parse_part_in(&inpos, (last-(inpos-instart)), &outpos, (sizeof(out)-(outpos-out)), FLAG_IGNORE_COMMAS); break;