]>
git.zerfleddert.de Git - usb-driver/blob - jtagkey.c
6 #include "usb-driver.h"
11 #define USBBUFSIZE 1048576
12 #define JTAG_SPEED 100000
13 #define BULK_LATENCY 2
14 #define OTHER_LATENCY 1
16 static struct ftdi_context ftdic
;
18 static int jtagkey_latency(int latency
) {
19 static int current
= 0;
22 if (current
!= latency
) {
23 DPRINTF("switching latency\n");
24 if ((ret
= ftdi_set_latency_timer(&ftdic
, latency
)) != 0) {
25 fprintf(stderr
, "unable to set latency timer: %d (%s)\n", ret
, ftdi_get_error_string(&ftdic
));
35 static int jtagkey_init(unsigned short vid
, unsigned short pid
) {
39 if ((ret
= ftdi_init(&ftdic
)) != 0) {
40 fprintf(stderr
, "unable to initialise libftdi: %d (%s)\n", ret
, ftdi_get_error_string(&ftdic
));
44 if ((ret
= ftdi_usb_open(&ftdic
, vid
, pid
)) != 0) {
45 fprintf(stderr
, "unable to open ftdi device: %d (%s)\n", ret
, ftdi_get_error_string(&ftdic
));
49 if ((ret
= ftdi_usb_reset(&ftdic
)) != 0) {
50 fprintf(stderr
, "unable reset device: %d (%s)\n", ret
, ftdi_get_error_string(&ftdic
));
54 if ((ret
= ftdi_set_interface(&ftdic
, INTERFACE_A
)) != 0) {
55 fprintf(stderr
, "unable to set interface: %d (%s)\n", ret
, ftdi_get_error_string(&ftdic
));
59 if ((ret
= ftdi_write_data_set_chunksize(&ftdic
, USBBUFSIZE
)) != 0) {
60 fprintf(stderr
, "unable to set write chunksize: %d (%s)\n", ret
, ftdi_get_error_string(&ftdic
));
64 if ((ret
= ftdi_read_data_set_chunksize(&ftdic
, USBBUFSIZE
)) != 0) {
65 fprintf(stderr
, "unable to set read chunksize: %d (%s)\n", ret
, ftdi_get_error_string(&ftdic
));
69 if ((ret
= jtagkey_latency(OTHER_LATENCY
)) != 0)
73 ftdi_write_data(&ftdic
, &c
, 1);
75 if ((ret
= ftdi_set_bitmode(&ftdic
, JTAGKEY_TCK
|JTAGKEY_TDI
|JTAGKEY_TMS
|JTAGKEY_OEn
, BITMODE_SYNCBB
)) != 0) {
76 fprintf(stderr
, "unable to enable bitbang mode: %d (%s)\n", ret
, ftdi_get_error_string(&ftdic
));
80 if ((ret
= ftdi_set_baudrate(&ftdic
, JTAG_SPEED
)) != 0) {
81 fprintf(stderr
, "unable to set baudrate: %d (%s)\n", ret
, ftdi_get_error_string(&ftdic
));
85 if ((ret
= ftdi_usb_purge_buffers(&ftdic
)) != 0) {
86 fprintf(stderr
, "unable to purge buffers: %d (%s)\n", ret
, ftdi_get_error_string(&ftdic
));
93 int jtagkey_open(int num
) {
96 ret
= jtagkey_init(config_usb_vid(num
), config_usb_pid(num
));
104 void jtagkey_close(int handle
) {
105 if (handle
== 0xff) {
106 ftdi_disable_bitbang(&ftdic
);
107 ftdi_usb_close(&ftdic
);
112 void jtagkey_state(unsigned char data
) {
113 fprintf(stderr
,"Pins high: ");
115 if (data
& JTAGKEY_TCK
)
116 fprintf(stderr
,"TCK ");
118 if (data
& JTAGKEY_TDI
)
119 fprintf(stderr
,"TDI ");
121 if (data
& JTAGKEY_TDO
)
122 fprintf(stderr
,"TDO ");
124 if (data
& JTAGKEY_TMS
)
125 fprintf(stderr
,"TMS ");
127 if (data
& JTAGKEY_VREF
)
128 fprintf(stderr
,"VREF ");
130 fprintf(stderr
,"\n");
133 struct jtagkey_reader_arg
{
138 static void *jtagkey_reader(void *thread_arg
) {
139 struct jtagkey_reader_arg
*arg
= (struct jtagkey_reader_arg
*)thread_arg
;
143 DPRINTF("reader for %d bytes\n", arg
->num
);
144 while (i
< arg
->num
) {
145 i
+= ftdi_read_data(&ftdic
, arg
->buf
+ i
, arg
->num
- i
);
151 /* TODO: Interpret JTAG commands and transfer in MPSSE mode */
152 int jtagkey_transfer(WD_TRANSFER
*tr
, int fd
, unsigned int request
, int ppbase
, int ecpbase
, int num
) {
158 static unsigned char last_data
= 0;
159 static unsigned char last_write
= 0x00;
160 static unsigned char writebuf
[USBBUFSIZE
], *writepos
= writebuf
;
161 static unsigned char readbuf
[USBBUFSIZE
], *readpos
;
162 unsigned char data
, prev_data
, last_cyc_write
;
163 struct jtagkey_reader_arg targ
;
164 pthread_t reader_thread
;
167 for (i
= 0; i
< num
; i
++)
168 if (tr
[i
].cmdTrans
== PP_READ
)
171 /* Write combining */
172 if ((writepos
-writebuf
> sizeof(writebuf
)-num
) || (nread
&& writepos
-writebuf
)) {
173 unsigned char *pos
= writebuf
;
176 DPRINTF("writing %d bytes due to %d following reads in %d chunks or full buffer\n", writepos
-writebuf
, nread
, num
);
177 jtagkey_latency(BULK_LATENCY
);
179 targ
.num
= writepos
-pos
;
181 pthread_create(&reader_thread
, NULL
, &jtagkey_reader
, &targ
);
183 while (pos
< writepos
) {
186 if (len
> USBBUFSIZE
)
189 DPRINTF("combined write of %d/%d\n",len
,writepos
-pos
);
190 ftdi_write_data(&ftdic
, pos
, len
);
193 pthread_join(reader_thread
, NULL
);
198 last_cyc_write
= last_write
;
200 for (i
= 0; i
< num
; i
++) {
201 DPRINTF("dwPort: 0x%lx, cmdTrans: %lu, dwbytes: %ld, fautoinc: %ld, dwoptions: %ld\n",
202 (unsigned long)tr
[i
].dwPort
, tr
[i
].cmdTrans
, tr
[i
].dwBytes
,
203 tr
[i
].fAutoinc
, tr
[i
].dwOptions
);
205 port
= (unsigned long)tr
[i
].dwPort
;
206 val
= tr
[i
].Data
.Byte
;
209 if (tr
[i
].cmdTrans
== 13)
210 DPRINTF("write byte: %d\n", val
);
212 if (tr
[i
].cmdTrans
== 13)
213 jtagmon(val
& PP_TCK
, val
& PP_TMS
, val
& PP_TDI
);
216 /* Pad writebuf for read-commands in stream */
217 *writepos
= last_data
;
218 prev_data
= last_data
;
220 if (port
== ppbase
+ PP_DATA
) {
221 DPRINTF("data port\n");
224 switch(tr
[i
].cmdTrans
) {
226 ret
= 0; /* We don't support reading of the data port */
268 fprintf(stderr
,"!!!Unsupported TRANSFER command: %lu!!!\n", tr
[i
].cmdTrans
);
274 if ((tr
[i
].cmdTrans
== PP_READ
) || (*writepos
!= prev_data
) || (i
== num
-1))
280 DPRINTF("writing %d bytes\n", writepos
-writebuf
);
282 *writepos
= last_data
;
285 jtagkey_latency(OTHER_LATENCY
);
287 targ
.num
= writepos
-writebuf
;
289 pthread_create(&reader_thread
, NULL
, &jtagkey_reader
, &targ
);
290 ftdi_write_data(&ftdic
, writebuf
, writepos
-writebuf
);
291 pthread_join(reader_thread
, NULL
);
295 hexdump(writebuf
, writepos
-writebuf
);
306 last_write
= last_cyc_write
;
308 for (i
= 0; i
< num
; i
++) {
309 DPRINTF("dwPort: 0x%lx, cmdTrans: %lu, dwbytes: %ld, fautoinc: %ld, dwoptions: %ld\n",
310 (unsigned long)tr
[i
].dwPort
, tr
[i
].cmdTrans
, tr
[i
].dwBytes
,
311 tr
[i
].fAutoinc
, tr
[i
].dwOptions
);
313 port
= (unsigned long)tr
[i
].dwPort
;
314 val
= tr
[i
].Data
.Byte
;
316 if ((tr
[i
].cmdTrans
!= PP_READ
) && (val
== last_write
) && (i
!= num
-1))
321 if (port
== ppbase
+ PP_DATA
) {
322 if (tr
[i
].cmdTrans
== PP_WRITE
) {
325 } else if (port
== ppbase
+ PP_STATUS
) {
326 DPRINTF("status port (last write: 0x%x)\n", last_write
);
327 switch(tr
[i
].cmdTrans
) {
332 DPRINTF("READ: 0x%x\n", data
);
337 if ((data
& JTAGKEY_TDO
) && (last_write
& PP_PROG
))
340 if (~last_write
& PP_PROG
)
343 if (last_write
& 0x40)
350 ret
= 0; /* Status Port is readonly */
354 fprintf(stderr
,"!!!Unsupported TRANSFER command: %lu!!!\n", tr
[i
].cmdTrans
);
362 tr
[i
].Data
.Byte
= val
;
364 DPRINTF("dwPortReturn: 0x%lx, cmdTrans: %lu, dwbytes: %ld, fautoinc: %ld, dwoptions: %ld\n",
365 (unsigned long)tr
[i
].dwPort
, tr
[i
].cmdTrans
, tr
[i
].dwBytes
,
366 tr
[i
].fAutoinc
, tr
[i
].dwOptions
);
368 if (tr
[i
].cmdTrans
== 10)
369 DPRINTF("read byte: %d\n", tr
[i
].Data
.Byte
);