diff --git a/fet.c b/fet.c index b11db34..f03b6f8 100644 --- a/fet.c +++ b/fet.c @@ -409,6 +409,16 @@ static int send_command(int command_code, /* Extra data */ if (extra) { + int x = exlen; + + datapkt[len++] = x & 0xff; + x >>= 8; + datapkt[len++] = x & 0xff; + x >>= 8; + datapkt[len++] = x & 0xff; + x >>= 8; + datapkt[len++] = x & 0xff; + memcpy(datapkt + len, extra, exlen); len += exlen; }