+
+ /* Queue packet until first respone to 'K' is received */
+ if (wait_for_h && buf[0] != 'H') {
+ struct queued_rx **rxp = &qrx;
+
+ while (*rxp)
+ rxp = &((*rxp)->next);
+
+ *rxp = malloc(sizeof(struct queued_rx));
+ if (!*rxp) {
+ perror("malloc");
+ return 0;
+ }
+
+ memset(*rxp, 0, sizeof(struct queued_rx));
+ (*rxp)->len = outpos-out;
+ (*rxp)->rx = malloc((*rxp)->len);
+ if (!(*rxp)->rx) {
+ perror("malloc");
+ return 0;
+ }
+ memset((*rxp)->rx, 0, (*rxp)->len);
+ memcpy((*rxp)->rx, out, (*rxp)->len);
+
+ return 1;
+ }
+
+ write_log((char*)out, outpos-out-2, "LAN < ");
+
+ w = write(fd, out, outpos-out);
+ if (w <= 0) {
+ perror("write");
+ return 0;
+ }
+
+ /* Send all queued packets */
+ if (wait_for_h) {
+ struct queued_rx *curr_rx = qrx;
+ struct queued_rx *last_rx;
+
+ while (curr_rx) {
+ write_log(curr_rx->rx, curr_rx->len-2, "LAN < ");
+
+ w = write(fd, curr_rx->rx, curr_rx->len);
+ if (w <= 0) {
+ perror("write");
+ }
+ last_rx = curr_rx;
+ curr_rx = curr_rx->next;
+
+ free(last_rx->rx);
+ free(last_rx);
+ }
+
+ qrx = NULL;
+
+ wait_for_h = 0;
+ }
+
+ return 1;
+}
+
+static int hmlan_parse_one(uint8_t *cmd, int last, void *data)
+{
+ struct hmcfgusb_dev *dev = data;
+ uint8_t out[0x40]; //FIXME!!!
+ uint8_t *outpos;
+ uint8_t *inpos = cmd;
+
+ outpos = out;
+
+ if (last == 0)
+ return 1;
+
+ write_log((char*)cmd, last, "LAN > ");
+
+ memset(out, 0, sizeof(out));
+ *outpos++ = *inpos++;
+
+ switch(*cmd) {
+ case 'S':
+ parse_part_in(&inpos, (last-(inpos-cmd)), &outpos, (sizeof(out)-(outpos-out)), 0);
+ parse_part_in(&inpos, (last-(inpos-cmd)), &outpos, (sizeof(out)-(outpos-out)), 0);
+ parse_part_in(&inpos, (last-(inpos-cmd)), &outpos, (sizeof(out)-(outpos-out)), 0);
+ parse_part_in(&inpos, (last-(inpos-cmd)), &outpos, (sizeof(out)-(outpos-out)), 0);
+ parse_part_in(&inpos, (last-(inpos-cmd)), &outpos, (sizeof(out)-(outpos-out)), 0);
+ parse_part_in(&inpos, (last-(inpos-cmd)), &outpos, (sizeof(out)-(outpos-out)), FLAG_LENGTH_BYTE);
+ break;
+ case 'Y':
+ parse_part_in(&inpos, (last-(inpos-cmd)), &outpos, (sizeof(out)-(outpos-out)), 0);
+ parse_part_in(&inpos, (last-(inpos-cmd)), &outpos, (sizeof(out)-(outpos-out)), 0);
+ parse_part_in(&inpos, (last-(inpos-cmd)), &outpos, (sizeof(out)-(outpos-out)), FLAG_LENGTH_BYTE);
+ break;
+ default:
+ parse_part_in(&inpos, (last-(inpos-cmd)), &outpos, (sizeof(out)-(outpos-out)), FLAG_IGNORE_COMMAS);
+ break;
+ }
+
+ hmcfgusb_send(dev, out, sizeof(out), 1);
+
+ return 1;