sys64738
/
blackmagic
1
0
Fork 0
Code Issues Pull Requests Projects Releases Wiki Activity

Linux jtagtap and swdptap now clean up before re-initialising.

This commit is contained in:
Gareth McMullin 2011-02-07 13:38:13 +13:00
parent 5cc8ff5404
commit 8628babbb0
4 changed files with 100 additions and 60 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

73
src/linux/jtagtap.c
View File

@ -50,8 +50,7 @@
#define TMS 0x08 #define TMS 0x08
#define nSRST 0x20 #define nSRST 0x20
static struct ftdi_context ftdic; struct ftdi_context *ftdic;
static int f;
#define BUF_SIZE 4096 #define BUF_SIZE 4096
static uint8_t outbuf[BUF_SIZE]; static uint8_t outbuf[BUF_SIZE];
@ -59,7 +58,7 @@ static uint16_t bufptr = 0;
static void buffer_flush(void) static void buffer_flush(void)
{ {
assert(ftdi_write_data(&ftdic, outbuf, bufptr) == bufptr); assert(ftdi_write_data(ftdic, outbuf, bufptr) == bufptr);
// printf("FT2232 buffer flush: %d bytes\n", bufptr); // printf("FT2232 buffer flush: %d bytes\n", bufptr);
bufptr = 0; bufptr = 0;
} }
@ -76,7 +75,7 @@ static int buffer_read(uint8_t *data, int size)
{ {
int index = 0; int index = 0;
buffer_flush(); buffer_flush();
while((index += ftdi_read_data(&ftdic, data + index, size-index)) != size); while((index += ftdi_read_data(ftdic, data + index, size-index)) != size);
return size; return size;
} }
@ -85,54 +84,62 @@ int jtagtap_init(void)
{ {
int err; int err;
if((err = ftdi_init(&ftdic)) != 0) { if(ftdic) {
fprintf(stderr, "ftdi_init: %d: %s\n", ftdi_usb_close(ftdic);
err, ftdi_get_error_string(&ftdic)); ftdi_free(ftdic);
ftdic = NULL;
}
if((ftdic = ftdi_new()) == NULL) {
fprintf(stderr, "ftdi_new: %s\n",
ftdi_get_error_string(ftdic));
abort(); abort();
} }
if((err = ftdi_set_interface(&ftdic, INTERFACE_A)) != 0) { if((err = ftdi_set_interface(ftdic, INTERFACE_A)) != 0) {
fprintf(stderr, "ftdi_set_interface: %d: %s\n", fprintf(stderr, "ftdi_set_interface: %d: %s\n",
err, ftdi_get_error_string(&ftdic)); err, ftdi_get_error_string(ftdic));
abort(); abort();
} }
f = ftdi_usb_open(&ftdic, FT2232_VID, FT2232_PID); if((err = ftdi_usb_open(ftdic, FT2232_VID, FT2232_PID)) != 0) {
if(f < 0 && f != -5) {
fprintf(stderr, "unable to open ftdi device: %d (%s)\n", fprintf(stderr, "unable to open ftdi device: %d (%s)\n",
f, ftdi_get_error_string(&ftdic)); err, ftdi_get_error_string(ftdic));
return -1; abort();
} }
fprintf(stderr, "ftdi open succeeded(channel 1): %d\n",f);
if((err = ftdi_set_latency_timer(&ftdic, 1)) != 0) { if((err = ftdi_set_latency_timer(ftdic, 1)) != 0) {
fprintf(stderr, "ftdi_set_latency_timer: %d: %s\n", fprintf(stderr, "ftdi_set_latency_timer: %d: %s\n",
err, ftdi_get_error_string(&ftdic)); err, ftdi_get_error_string(ftdic));
abort(); abort();
} }
if((err = ftdi_set_baudrate(&ftdic, 1000000)) != 0) { if((err = ftdi_set_baudrate(ftdic, 1000000)) != 0) {
fprintf(stderr, "ftdi_set_baudrate: %d: %s\n", fprintf(stderr, "ftdi_set_baudrate: %d: %s\n",
err, ftdi_get_error_string(&ftdic)); err, ftdi_get_error_string(ftdic));
abort(); abort();
} }
if((err = ftdi_usb_purge_buffers(&ftdic)) != 0) { if((err = ftdi_usb_purge_buffers(ftdic)) != 0) {
fprintf(stderr, "ftdi_set_baudrate: %d: %s\n", fprintf(stderr, "ftdi_set_baudrate: %d: %s\n",
err, ftdi_get_error_string(&ftdic)); err, ftdi_get_error_string(ftdic));
abort(); abort();
} }
if((err = ftdi_set_bitmode(&ftdic, 0xAB, BITMODE_MPSSE)) != 0) { if((err = ftdi_set_bitmode(ftdic, 0xAB, BITMODE_MPSSE)) != 0) {
fprintf(stderr, "ftdi_set_bitmode: %d: %s\n", fprintf(stderr, "ftdi_set_bitmode: %d: %s\n",
err, ftdi_get_error_string(&ftdic)); err, ftdi_get_error_string(ftdic));
abort(); abort();
} }
assert(ftdi_write_data(&ftdic, "\x86\x00\x00\x80\xA8\xAB", 6) == 6); assert(ftdi_write_data(ftdic, "\x86\x00\x00\x80\xA8\xAB", 6) == 6);
if((err = ftdi_write_data_set_chunksize(&ftdic, BUF_SIZE)) != 0) { if((err = ftdi_write_data_set_chunksize(ftdic, BUF_SIZE)) != 0) {
fprintf(stderr, "ftdi_write_data_set_chunksize: %d: %s\n", fprintf(stderr, "ftdi_write_data_set_chunksize: %d: %s\n",
err, ftdi_get_error_string(&ftdic)); err, ftdi_get_error_string(ftdic));
abort(); abort();
} }
/* Go to JTAG mode for SWJ-DP */
for(int i = 0; i <= 50; i++) jtagtap_next(1, 0); /* Reset SW-DP */
jtagtap_tms_seq(0xE73C, 16); /* SWD to JTAG sequence */
jtagtap_soft_reset();
return 0; return 0;
} }
@ -144,9 +151,9 @@ void jtagtap_reset(void)
void jtagtap_srst(void) void jtagtap_srst(void)
{ {
buffer_flush(); buffer_flush();
//ftdi_write_data(&ftdic, "\x80\x88\xAB", 3); //ftdi_write_data(ftdic, "\x80\x88\xAB", 3);
//usleep(1000); //usleep(1000);
//ftdi_write_data(&ftdic, "\x80\xA8\xAB", 3); //ftdi_write_data(ftdic, "\x80\xA8\xAB", 3);
} }
#ifndef PROVIDE_GENERIC_TAP_TMS_SEQ #ifndef PROVIDE_GENERIC_TAP_TMS_SEQ
@ -159,7 +166,7 @@ jtagtap_tms_seq(uint32_t MS, int ticks)
tmp[1] = ticks<7?ticks-1:6; tmp[1] = ticks<7?ticks-1:6;
tmp[2] = 0x80 | (MS & 0x7F); tmp[2] = 0x80 | (MS & 0x7F);
// assert(ftdi_write_data(&ftdic, tmp, 3) == 3); // assert(ftdi_write_data(ftdic, tmp, 3) == 3);
buffer_write(tmp, 3); buffer_write(tmp, 3);
MS >>= 7; ticks -= 7; MS >>= 7; ticks -= 7;
} }
@ -199,7 +206,7 @@ jtagtap_tdi_seq(const uint8_t final_tms, const uint8_t *DI, int ticks)
tmp[index++] = 0; tmp[index++] = 0;
tmp[index++] = (*DI)>>rticks?0x81:0x01; tmp[index++] = (*DI)>>rticks?0x81:0x01;
} }
// assert(ftdi_write_data(&ftdic, tmp, index) == index); // assert(ftdi_write_data(ftdic, tmp, index) == index);
buffer_write(tmp, index); buffer_write(tmp, index);
} }
#endif #endif
@ -240,10 +247,10 @@ jtagtap_tdi_tdo_seq(uint8_t *DO, const uint8_t final_tms, const uint8_t *DI, int
tmp[index++] = 0; tmp[index++] = 0;
tmp[index++] = (*DI)>>rticks?0x81:0x01; tmp[index++] = (*DI)>>rticks?0x81:0x01;
} }
// assert(ftdi_write_data(&ftdic, tmp, index) == index); // assert(ftdi_write_data(ftdic, tmp, index) == index);
buffer_write(tmp, index); buffer_write(tmp, index);
// index = 0; // index = 0;
// while((index += ftdi_read_data(&ftdic, tmp + index, rsize-index)) != rsize); // while((index += ftdi_read_data(ftdic, tmp + index, rsize-index)) != rsize);
buffer_read(tmp, rsize); buffer_read(tmp, rsize);
/*for(index = 0; index < rsize; index++) /*for(index = 0; index < rsize; index++)
printf("%02X ", tmp[index]); printf("%02X ", tmp[index]);
@ -272,8 +279,8 @@ uint8_t jtagtap_next(uint8_t dTMS, uint8_t dTDO)
uint8_t ret; uint8_t ret;
uint8_t tmp[3] = "\x6B\x00\x00"; uint8_t tmp[3] = "\x6B\x00\x00";
tmp[2] = (dTDO?0x80:0) | (dTMS?0x01:0); tmp[2] = (dTDO?0x80:0) | (dTMS?0x01:0);
// assert(ftdi_write_data(&ftdic, tmp, 3) == 3); // assert(ftdi_write_data(ftdic, tmp, 3) == 3);
// while(ftdi_read_data(&ftdic, &ret, 1) != 1); // while(ftdi_read_data(ftdic, &ret, 1) != 1);
buffer_write(tmp, 3); buffer_write(tmp, 3);
buffer_read(&ret, 1); buffer_read(&ret, 1);

3
src/linux/platform.h
View File

@ -22,6 +22,7 @@
#define __PLATFORM_H #define __PLATFORM_H
#include <stdint.h> #include <stdint.h>
#include <ftdi.h>
#define FT2232_VID 0x0403 #define FT2232_VID 0x0403
#define FT2232_PID 0xbcd9 #define FT2232_PID 0xbcd9
@ -36,6 +37,8 @@
#define morse(x, y) do {} while(0) #define morse(x, y) do {} while(0)
#define morse_msg 0 #define morse_msg 0
extern struct ftdi_context *ftdic;
int platform_init(void); int platform_init(void);
#endif #endif

83
src/linux/swdptap.c
View File

@ -29,32 +29,63 @@
#include "platform.h" #include "platform.h"
#include "swdptap.h" #include "swdptap.h"
static struct ftdi_context ftdic;
static int f;
#define BUF_SIZE 4096 #define BUF_SIZE 4096
int swdptap_init(void) int swdptap_init(void)
{ {
ftdi_init(&ftdic); int err;
ftdi_set_interface(&ftdic, INTERFACE_A);
f = ftdi_usb_open(&ftdic, FT2232_VID, FT2232_PID);
if(f < 0 && f != -5) {
fprintf(stderr, "unable to open ftdi device: %d (%s)\n",
f, ftdi_get_error_string(&ftdic));
return -1;
}
printf("ftdi open succeeded(channel 1): %d\n",f);
ftdi_set_latency_timer(&ftdic, 1); if(ftdic) {
ftdi_set_baudrate(&ftdic, 10000000); ftdi_usb_close(ftdic);
ftdi_usb_purge_buffers(&ftdic); ftdi_free(ftdic);
ftdic = NULL;
}
if((ftdic = ftdi_new()) == NULL) {
fprintf(stderr, "ftdi_new: %s\n",
ftdi_get_error_string(ftdic));
abort();
}
if((err = ftdi_set_interface(ftdic, INTERFACE_A)) != 0) {
fprintf(stderr, "ftdi_set_interface: %d: %s\n",
err, ftdi_get_error_string(ftdic));
abort();
}
if((err = ftdi_usb_open(ftdic, FT2232_VID, FT2232_PID)) != 0) {
fprintf(stderr, "unable to open ftdi device: %d (%s)\n",
err, ftdi_get_error_string(ftdic));
abort();
}
if((err = ftdi_set_latency_timer(ftdic, 1)) != 0) {
fprintf(stderr, "ftdi_set_latency_timer: %d: %s\n",
err, ftdi_get_error_string(ftdic));
abort();
}
if((err = ftdi_set_baudrate(ftdic, 1000000)) != 0) {
fprintf(stderr, "ftdi_set_baudrate: %d: %s\n",
err, ftdi_get_error_string(ftdic));
abort();
}
if((err = ftdi_usb_purge_buffers(ftdic)) != 0) {
fprintf(stderr, "ftdi_set_baudrate: %d: %s\n",
err, ftdi_get_error_string(ftdic));
abort();
}
printf("enabling bitbang mode(channel 1)\n"); printf("enabling bitbang mode(channel 1)\n");
assert(ftdi_set_bitmode(&ftdic, 0xAB, BITMODE_BITBANG) == 0); if((err = ftdi_set_bitmode(ftdic, 0xAB, BITMODE_BITBANG)) != 0) {
//assert(ftdi_write_data(&ftdic, "\x86\x00\x00\x80\xA8\xAB", 6) == 6); fprintf(stderr, "ftdi_set_bitmode: %d: %s\n",
ftdi_write_data(&ftdic, "\xAB\xA8", 2); err, ftdi_get_error_string(ftdic));
ftdi_write_data_set_chunksize(&ftdic, BUF_SIZE); abort();
}
assert(ftdi_write_data(ftdic, "\xAB\xA8", 2) == 2);
if((err = ftdi_write_data_set_chunksize(ftdic, BUF_SIZE)) != 0) {
fprintf(stderr, "ftdi_write_data_set_chunksize: %d: %s\n",
err, ftdi_get_error_string(ftdic));
abort();
}
/* This must be investigated in more detail. /* This must be investigated in more detail.
* As described in STM32 Reference Manual... */ * As described in STM32 Reference Manual... */
@ -83,23 +114,23 @@ void swdptap_turnaround(uint8_t dir)
olddir = dir; olddir = dir;
if(dir) /* SWDIO goes to input */ if(dir) /* SWDIO goes to input */
assert(ftdi_set_bitmode(&ftdic, 0xA3, BITMODE_BITBANG) == 0); assert(ftdi_set_bitmode(ftdic, 0xA3, BITMODE_BITBANG) == 0);
/* One clock cycle */ /* One clock cycle */
ftdi_write_data(&ftdic, "\xAB\xA8", 2); ftdi_write_data(ftdic, "\xAB\xA8", 2);
if(!dir) /* SWDIO goes to output */ if(!dir) /* SWDIO goes to output */
assert(ftdi_set_bitmode(&ftdic, 0xAB, BITMODE_BITBANG) == 0); assert(ftdi_set_bitmode(ftdic, 0xAB, BITMODE_BITBANG) == 0);
} }
uint8_t swdptap_bit_in(void) uint8_t swdptap_bit_in(void)
{ {
uint8_t ret; uint8_t ret;
//ftdi_read_data(&ftdic, &ret, 1); //ftdi_read_data(ftdic, &ret, 1);
ftdi_read_pins(&ftdic, &ret); ftdi_read_pins(ftdic, &ret);
ret &= 0x08; ret &= 0x08;
ftdi_write_data(&ftdic, "\xA1\xA0", 2); ftdi_write_data(ftdic, "\xA1\xA0", 2);
DEBUG("%d", ret?1:0); DEBUG("%d", ret?1:0);
@ -116,7 +147,7 @@ void swdptap_bit_out(uint8_t val)
for(int i = 0; i < 3; i++) for(int i = 0; i < 3; i++)
buf[i] |= 0x08; buf[i] |= 0x08;
} }
ftdi_write_data(&ftdic, buf, 3); ftdi_write_data(ftdic, buf, 3);
} }
uint32_t swdptap_seq_in(int ticks) uint32_t swdptap_seq_in(int ticks)

1
src/main.c
View File

@ -38,7 +38,6 @@ main(void)
{ {
assert(platform_init() == 0); assert(platform_init() == 0);
assert(gdb_if_init() == 0); assert(gdb_if_init() == 0);
assert(jtagtap_init() == 0);
jtag_scan(); jtag_scan();
// adiv5_swdp_scan(); // adiv5_swdp_scan();