]>
git.zerfleddert.de Git - usb-driver/blob - jtagkey.c
4 #include "usb-driver.h"
7 #define USBBUFSIZE 4096
9 static struct ftdi_context ftdic
;
10 static unsigned int usb_maxlen
= 0;
11 static unsigned char bitbang_mode
;
13 int jtagkey_init(unsigned short vid
, unsigned short pid
) {
17 if ((ret
= ftdi_init(&ftdic
)) != 0) {
18 fprintf(stderr
, "unable to initialise libftdi: %d (%s)\n", ret
, ftdi_get_error_string(&ftdic
));
22 if ((ret
= ftdi_usb_open(&ftdic
, vid
, pid
)) != 0) {
23 fprintf(stderr
, "unable to open ftdi device: %d (%s)\n", ret
, ftdi_get_error_string(&ftdic
));
27 if ((ret
= ftdi_usb_reset(&ftdic
)) != 0) {
28 fprintf(stderr
, "unable reset device: %d (%s)\n", ret
, ftdi_get_error_string(&ftdic
));
32 if ((ret
= ftdi_set_interface(&ftdic
, INTERFACE_A
)) != 0) {
33 fprintf(stderr
, "unable to set interface: %d (%s)\n", ret
, ftdi_get_error_string(&ftdic
));
38 if ((ret
= ftdi_write_data_get_chunksize(&ftdic
, &usb_maxlen
)) != 0) {
39 fprintf(stderr
, "unable to get write chunksize: %d (%s)\n", ret
, ftdi_get_error_string(&ftdic
));
43 if ((ret
= ftdi_set_latency_timer(&ftdic
, 1)) != 0) {
44 fprintf(stderr
, "unable to set latency timer: %d (%s)\n", ret
, ftdi_get_error_string(&ftdic
));
48 if ((ret
= ftdi_set_baudrate(&ftdic
, 500000)) != 0) {
49 fprintf(stderr
, "unable to set baudrate: %d (%s)\n", ret
, ftdi_get_error_string(&ftdic
));
54 ftdi_write_data(&ftdic
, &c
, 1);
56 if ((ret
= ftdi_set_bitmode(&ftdic
, JTAGKEY_TCK
|JTAGKEY_TDI
|JTAGKEY_TMS
|JTAGKEY_OEn
, BITMODE_BITBANG
)) != 0) {
57 fprintf(stderr
, "unable to enable bitbang mode: %d (%s)\n", ret
, ftdi_get_error_string(&ftdic
));
61 bitbang_mode
= BITMODE_BITBANG
;
63 if ((ret
= ftdi_usb_purge_buffers(&ftdic
)) != 0) {
64 fprintf(stderr
, "unable to purge buffers: %d (%s)\n", ret
, ftdi_get_error_string(&ftdic
));
71 void jtagkey_close() {
72 ftdi_disable_bitbang(&ftdic
);
73 ftdi_usb_close(&ftdic
);
77 static int jtagkey_set_bbmode(unsigned char mode
) {
80 if (bitbang_mode
!= mode
) {
81 DPRINTF("switching bitbang-mode!\n");
82 /* Wait for the latency-timer to kick in */
84 if ((ret
= ftdi_set_bitmode(&ftdic
, JTAGKEY_TCK
|JTAGKEY_TDI
|JTAGKEY_TMS
|JTAGKEY_OEn
, mode
)) != 0) {
85 fprintf(stderr
, "unable to enable bitbang mode: %d (%s)\n", ret
, ftdi_get_error_string(&ftdic
));
88 if ((ret
= ftdi_usb_purge_buffers(&ftdic
)) != 0) {
89 fprintf(stderr
, "unable to purge buffers: %d (%s)\n", ret
, ftdi_get_error_string(&ftdic
));
92 /* Wait for the FTDI2232 to settle */
101 void jtagkey_state(unsigned char data
) {
102 fprintf(stderr
,"Pins high: ");
104 if (data
& JTAGKEY_TCK
)
105 fprintf(stderr
,"TCK ");
107 if (data
& JTAGKEY_TDI
)
108 fprintf(stderr
,"TDI ");
110 if (data
& JTAGKEY_TDO
)
111 fprintf(stderr
,"TDO ");
113 if (data
& JTAGKEY_TMS
)
114 fprintf(stderr
,"TMS ");
116 if (data
& JTAGKEY_VREF
)
117 fprintf(stderr
,"VREF ");
119 fprintf(stderr
,"\n");
122 int jtagkey_transfer(WD_TRANSFER
*tr
, int fd
, unsigned int request
, int ppbase
, int ecpbase
, int num
) {
128 static unsigned char last_data
= 0;
129 static unsigned char last_write
= 0x00;
130 static unsigned char writebuf
[USBBUFSIZE
], *writepos
= writebuf
;
131 static unsigned char readbuf
[USBBUFSIZE
], *readpos
;
132 unsigned char data
, prev_data
;
135 for (i
= 0; i
< num
; i
++)
136 if (tr
[i
].cmdTrans
== PP_READ
)
139 /* Write combining */
140 if ((writepos
-writebuf
> sizeof(writebuf
)-num
) || (nread
&& writepos
-writebuf
)) {
141 unsigned char *pos
= writebuf
;
143 DPRINTF("writing %d bytes due to %d following reads in %d chunks or full buffer\n", writepos
-writebuf
, nread
, num
);
145 jtagkey_set_bbmode(BITMODE_BITBANG
);
146 while (pos
< writepos
) {
149 if (len
> usb_maxlen
)
152 DPRINTF("combined write of %d/%d\n",len
,writepos
-pos
);
153 ftdi_write_data(&ftdic
, pos
, len
);
157 DPRINTF("read %d/%d bytes\n", i
, writepos
-writebuf
);
161 for (i
= 0; i
< num
; i
++) {
162 DPRINTF("dwPort: 0x%lx, cmdTrans: %lu, dwbytes: %ld, fautoinc: %ld, dwoptions: %ld\n",
163 (unsigned long)tr
[i
].dwPort
, tr
[i
].cmdTrans
, tr
[i
].dwBytes
,
164 tr
[i
].fAutoinc
, tr
[i
].dwOptions
);
166 port
= (unsigned long)tr
[i
].dwPort
;
167 val
= tr
[i
].Data
.Byte
;
170 if (tr
[i
].cmdTrans
== 13)
171 DPRINTF("write byte: %d\n", val
);
174 /* Pad writebuf for read-commands in stream */
175 *writepos
= last_data
;
176 prev_data
= last_data
;
178 if (port
== ppbase
+ PP_DATA
) {
179 DPRINTF("data port\n");
182 switch(tr
[i
].cmdTrans
) {
184 ret
= 0; /* We don't support reading of the data port */
226 fprintf(stderr
,"!!!Unsupported TRANSFER command: %lu!!!\n", tr
[i
].cmdTrans
);
232 if (nread
|| (*writepos
!= prev_data
))
238 DPRINTF("writing %d bytes\n", writepos
-writebuf
);
239 jtagkey_set_bbmode(BITMODE_SYNCBB
);
240 ftdi_write_data(&ftdic
, writebuf
, writepos
-writebuf
);
243 while (i
< writepos
-writebuf
) {
244 i
+= ftdi_read_data(&ftdic
, readbuf
, sizeof(readbuf
));
249 hexdump(writebuf
, writepos
-writebuf
);
261 for (i
= 0; i
< num
; i
++) {
262 DPRINTF("dwPort: 0x%lx, cmdTrans: %lu, dwbytes: %ld, fautoinc: %ld, dwoptions: %ld\n",
263 (unsigned long)tr
[i
].dwPort
, tr
[i
].cmdTrans
, tr
[i
].dwBytes
,
264 tr
[i
].fAutoinc
, tr
[i
].dwOptions
);
266 port
= (unsigned long)tr
[i
].dwPort
;
267 val
= tr
[i
].Data
.Byte
;
270 if (port
== ppbase
+ PP_DATA
) {
271 if (tr
[i
].cmdTrans
== PP_WRITE
) {
274 } else if (port
== ppbase
+ PP_STATUS
) {
275 DPRINTF("status port (last write: 0x%x)\n", last_write
);
276 switch(tr
[i
].cmdTrans
) {
280 DPRINTF("READ: 0x%x\n", data
);
285 if ((data
& JTAGKEY_TDO
) && (last_write
& PP_PROG
))
288 if (!(last_write
& PP_PROG
))
291 if (last_write
& 0x40)
298 ret
= 0; /* Status Port is readonly */
302 fprintf(stderr
,"!!!Unsupported TRANSFER command: %lu!!!\n", tr
[i
].cmdTrans
);
310 tr
[i
].Data
.Byte
= val
;
312 DPRINTF("dwPortReturn: 0x%lx, cmdTrans: %lu, dwbytes: %ld, fautoinc: %ld, dwoptions: %ld\n",
313 (unsigned long)tr
[i
].dwPort
, tr
[i
].cmdTrans
, tr
[i
].dwBytes
,
314 tr
[i
].fAutoinc
, tr
[i
].dwOptions
);
316 if (tr
[i
].cmdTrans
== 10)
317 DPRINTF("read byte: %d\n", tr
[i
].Data
.Byte
);