+ }
+
+ if (nread || (*writepos != prev_data))
+ writepos++;
+ }
+
+ if (nread)
+ {
+ DPRINTF("writing %d bytes\n", writepos-writebuf);
+
+ *writepos = last_data;
+ writepos++;
+
+ jtagkey_set_bbmode(BITMODE_SYNCBB);
+ ftdi_write_data(&ftdic, writebuf, writepos-writebuf);
+
+ i = 0;
+ while (i < writepos-writebuf) {
+ i += ftdi_read_data(&ftdic, readbuf, sizeof(readbuf));
+ }
+
+#ifdef DEBUG
+ DPRINTF("write: ");
+ hexdump(writebuf, writepos-writebuf);
+ DPRINTF("read: ");
+ hexdump(readbuf, i);
+#endif
+
+ writepos = writebuf;
+ } else {
+ return ret;
+ }
+
+ readpos = readbuf;
+
+ for (i = 0; i < num; i++) {
+ DPRINTF("dwPort: 0x%lx, cmdTrans: %lu, dwbytes: %ld, fautoinc: %ld, dwoptions: %ld\n",
+ (unsigned long)tr[i].dwPort, tr[i].cmdTrans, tr[i].dwBytes,
+ tr[i].fAutoinc, tr[i].dwOptions);
+
+ port = (unsigned long)tr[i].dwPort;
+ val = tr[i].Data.Byte;
+ readpos++;
+
+ if (port == ppbase + PP_DATA) {
+ if (tr[i].cmdTrans == PP_WRITE) {
+ last_write = val;
+ }