jtag: add support for some probes that are mostly compatible with opendous

This patch adds support for usbprog-jtag and usbvlab that are mostly compatible
to opendous except for IN and OUT endpoints and usb transfer mode.

Change-Id: I44557c2449fe7473295038efa6ae4fc8d80ec7bf
Signed-off-by: Stefan Mahr <stefan.mahr@sphairon.com>
Reviewed-on: http://openocd.zylin.com/687
Tested-by: jenkins
Reviewed-by: Spencer Oliver <spen@spen-soft.co.uk>
__archive__
Stefan Mahr 2012-06-05 23:22:38 +02:00 committed by Spencer Oliver
parent 30fde70c03
commit 700e7605fe
5 changed files with 174 additions and 29 deletions

View File

@ -67,6 +67,21 @@ void jtag_libusb_close(jtag_libusb_device_handle *dev)
usb_close(dev); usb_close(dev);
} }
int jtag_libusb_control_transfer(jtag_libusb_device_handle *dev, uint8_t requestType,
uint8_t request, uint16_t wValue, uint16_t wIndex, char *bytes,
uint16_t size, unsigned int timeout)
{
int transferred = 0;
transferred = usb_control_msg(dev, requestType, request, wValue, wIndex,
bytes, size, timeout);
if (transferred < 0)
transferred = 0;
return transferred;
}
int jtag_libusb_bulk_write(jtag_libusb_device_handle *dev, int ep, char *bytes, int jtag_libusb_bulk_write(jtag_libusb_device_handle *dev, int ep, char *bytes,
int size, int timeout) int size, int timeout)
{ {

View File

@ -35,6 +35,12 @@
#define jtag_libusb_reset_device(dev) usb_reset(dev) #define jtag_libusb_reset_device(dev) usb_reset(dev)
#define jtag_libusb_get_device(devh) usb_device(devh) #define jtag_libusb_get_device(devh) usb_device(devh)
/* make some defines compatible to libusb1 */
#define LIBUSB_REQUEST_TYPE_VENDOR USB_TYPE_VENDOR
#define LIBUSB_RECIPIENT_DEVICE USB_RECIP_DEVICE
#define LIBUSB_ENDPOINT_OUT USB_ENDPOINT_OUT
#define LIBUSB_ENDPOINT_IN USB_ENDPOINT_IN
static inline int jtag_libusb_claim_interface(jtag_libusb_device_handle *devh, static inline int jtag_libusb_claim_interface(jtag_libusb_device_handle *devh,
int iface) int iface)
{ {
@ -44,6 +50,9 @@ static inline int jtag_libusb_claim_interface(jtag_libusb_device_handle *devh,
int jtag_libusb_open(const uint16_t vids[], const uint16_t pids[], int jtag_libusb_open(const uint16_t vids[], const uint16_t pids[],
struct jtag_libusb_device_handle **out); struct jtag_libusb_device_handle **out);
void jtag_libusb_close(jtag_libusb_device_handle *dev); void jtag_libusb_close(jtag_libusb_device_handle *dev);
int jtag_libusb_control_transfer(jtag_libusb_device_handle *dev,
uint8_t requestType, uint8_t request, uint16_t wValue,
uint16_t wIndex, char *bytes, uint16_t size, unsigned int timeout);
int jtag_libusb_bulk_write(struct jtag_libusb_device_handle *dev, int ep, int jtag_libusb_bulk_write(struct jtag_libusb_device_handle *dev, int ep,
char *bytes, int size, int timeout); char *bytes, int size, int timeout);
int jtag_libusb_bulk_read(struct jtag_libusb_device_handle *dev, int ep, int jtag_libusb_bulk_read(struct jtag_libusb_device_handle *dev, int ep,

View File

@ -79,6 +79,21 @@ void jtag_libusb_close(jtag_libusb_device_handle *dev)
libusb_exit(jtag_libusb_context); libusb_exit(jtag_libusb_context);
} }
int jtag_libusb_control_transfer(jtag_libusb_device_handle *dev, uint8_t requestType,
uint8_t request, uint16_t wValue, uint16_t wIndex, char *bytes,
uint16_t size, unsigned int timeout)
{
int transferred = 0;
transferred = libusb_control_transfer(dev, requestType, request, wValue, wIndex,
(unsigned char *)bytes, size, timeout);
if (transferred < 0)
transferred = 0;
return transferred;
}
int jtag_libusb_bulk_write(jtag_libusb_device_handle *dev, int ep, char *bytes, int jtag_libusb_bulk_write(jtag_libusb_device_handle *dev, int ep, char *bytes,
int size, int timeout) int size, int timeout)
{ {

View File

@ -44,6 +44,9 @@ static inline int jtag_libusb_claim_interface(jtag_libusb_device_handle *devh,
int jtag_libusb_open(const uint16_t vids[], const uint16_t pids[], int jtag_libusb_open(const uint16_t vids[], const uint16_t pids[],
struct jtag_libusb_device_handle **out); struct jtag_libusb_device_handle **out);
void jtag_libusb_close(jtag_libusb_device_handle *dev); void jtag_libusb_close(jtag_libusb_device_handle *dev);
int jtag_libusb_control_transfer(jtag_libusb_device_handle *dev,
uint8_t requestType, uint8_t request, uint16_t wValue,
uint16_t wIndex, char *bytes, uint16_t size, unsigned int timeout);
int jtag_libusb_bulk_write(struct jtag_libusb_device_handle *dev, int ep, int jtag_libusb_bulk_write(struct jtag_libusb_device_handle *dev, int ep,
char *bytes, int size, int timeout); char *bytes, int size, int timeout);
int jtag_libusb_bulk_read(struct jtag_libusb_device_handle *dev, int ep, int jtag_libusb_bulk_read(struct jtag_libusb_device_handle *dev, int ep,

View File

@ -39,39 +39,59 @@
#include <sys/timeb.h> #include <sys/timeb.h>
#include <time.h> #include <time.h>
#define ESTICK_VID 0x1781 #define OPENDOUS_MAX_VIDS_PIDS 4
#define ESTICK_PID 0xC0C0 /* define some probes with similar interface */
struct opendous_probe {
char *name;
uint16_t VID[OPENDOUS_MAX_VIDS_PIDS];
uint16_t PID[OPENDOUS_MAX_VIDS_PIDS];
uint8_t READ_EP;
uint8_t WRITE_EP;
uint8_t CONTROL_TRANSFER;
int BUFFERSIZE;
};
#define OPENDOUS_VID 0x03EB static struct opendous_probe opendous_probes[] = {
#define OPENDOUS_PID 0x204F {"usbprog-jtag", {0x1781, 0}, {0x0C63, 0}, 0x82, 0x02, 0x00, 510 },
{"opendous", {0x1781, 0x03EB, 0}, {0xC0C0, 0x204F, 0}, 0x81, 0x02, 0x00, 360 },
{"usbvlab", {0x16C0, 0}, {0x05DC, 0}, 0x81, 0x02, 0x01, 360 },
{NULL, {0x0000}, {0x0000}, 0x00, 0x00, 0x00, 0 }
};
/* pid could be specified at runtime */ #define OPENDOUS_WRITE_ENDPOINT (opendous_probe->WRITE_EP)
static uint16_t vids[] = { OPENDOUS_VID, ESTICK_VID, 0 }; #define OPENDOUS_READ_ENDPOINT (opendous_probe->READ_EP)
static uint16_t pids[] = { OPENDOUS_PID, ESTICK_PID, 0 };
#define OPENDOUS_WRITE_ENDPOINT 0x02
#define OPENDOUS_READ_ENDPOINT 0x81
static unsigned int opendous_hw_jtag_version = 1; static unsigned int opendous_hw_jtag_version = 1;
#define OPENDOUS_USB_TIMEOUT 1000 #define OPENDOUS_USB_TIMEOUT 1000
#define OPENDOUS_USB_BUFFER_SIZE 360 #define OPENDOUS_USB_BUFFER_SIZE (opendous_probe->BUFFERSIZE)
#define OPENDOUS_IN_BUFFER_SIZE (OPENDOUS_USB_BUFFER_SIZE) #define OPENDOUS_IN_BUFFER_SIZE (OPENDOUS_USB_BUFFER_SIZE)
#define OPENDOUS_OUT_BUFFER_SIZE (OPENDOUS_USB_BUFFER_SIZE) #define OPENDOUS_OUT_BUFFER_SIZE (OPENDOUS_USB_BUFFER_SIZE)
/* Global USB buffers */ /* Global USB buffers */
static uint8_t usb_in_buffer[OPENDOUS_IN_BUFFER_SIZE]; static uint8_t *usb_in_buffer;
static uint8_t usb_out_buffer[OPENDOUS_OUT_BUFFER_SIZE]; static uint8_t *usb_out_buffer;
/* Constants for OPENDOUS command */ /* Constants for OPENDOUS command */
#define OPENDOUS_MAX_SPEED 66 #define OPENDOUS_MAX_SPEED 66
#define OPENDOUS_MAX_TAP_TRANSMIT 350 /* even number is easier to handle */ #define OPENDOUS_MAX_TAP_TRANSMIT ((opendous_probe->BUFFERSIZE)-10)
#define OPENDOUS_MAX_INPUT_DATA (OPENDOUS_MAX_TAP_TRANSMIT*4) #define OPENDOUS_MAX_INPUT_DATA (OPENDOUS_MAX_TAP_TRANSMIT*4)
/* TAP */
#define OPENDOUS_TAP_BUFFER_SIZE 65536 #define OPENDOUS_TAP_BUFFER_SIZE 65536
struct pending_scan_result {
int first; /* First bit position in tdo_buffer to read */
int length; /* Number of bits to read */
struct scan_command *command; /* Corresponding scan command */
uint8_t *buffer;
};
static int pending_scan_results_length;
static struct pending_scan_result *pending_scan_results_buffer;
#define MAX_PENDING_SCAN_RESULTS (OPENDOUS_MAX_INPUT_DATA) #define MAX_PENDING_SCAN_RESULTS (OPENDOUS_MAX_INPUT_DATA)
/* JTAG usb commands */ /* JTAG usb commands */
@ -84,6 +104,14 @@ static uint8_t usb_out_buffer[OPENDOUS_OUT_BUFFER_SIZE];
#define JTAG_CMD_SET_SRST_TRST 0x6 #define JTAG_CMD_SET_SRST_TRST 0x6
#define JTAG_CMD_READ_CONFIG 0x7 #define JTAG_CMD_READ_CONFIG 0x7
/* usbvlab control transfer */
#define FUNC_START_BOOTLOADER 30
#define FUNC_WRITE_DATA 0x50
#define FUNC_READ_DATA 0x51
static char *opendous_type;
static struct opendous_probe *opendous_probe;
/* External interface functions */ /* External interface functions */
static int opendous_execute_queue(void); static int opendous_execute_queue(void);
static int opendous_init(void); static int opendous_init(void);
@ -132,6 +160,22 @@ static struct opendous_jtag *opendous_jtag_handle;
/***************************************************************************/ /***************************************************************************/
/* External interface implementation */ /* External interface implementation */
COMMAND_HANDLER(opendous_handle_opendous_type_command)
{
if (CMD_ARGC == 0)
return ERROR_OK;
/* only if the cable name wasn't overwritten by cmdline */
if (opendous_type == NULL) {
/* REVISIT first verify that it's listed in cables[] ... */
opendous_type = strdup(CMD_ARGV[0]);
}
/* REVISIT it's probably worth returning the current value ... */
return ERROR_OK;
}
COMMAND_HANDLER(opendous_handle_opendous_info_command) COMMAND_HANDLER(opendous_handle_opendous_info_command)
{ {
if (opendous_get_version_info() == ERROR_OK) { if (opendous_get_version_info() == ERROR_OK) {
@ -184,6 +228,13 @@ static const struct command_registration opendous_command_handlers[] = {
.help = "access opendous HW JTAG command version", .help = "access opendous HW JTAG command version",
.usage = "[2|3]", .usage = "[2|3]",
}, },
{
.name = "opendous_type",
.handler = &opendous_handle_opendous_type_command,
.mode = COMMAND_CONFIG,
.help = "set opendous type",
.usage = "[usbvlab|usbprog-jtag|opendous]",
},
COMMAND_REGISTRATION_DONE COMMAND_REGISTRATION_DONE
}; };
@ -273,6 +324,34 @@ static int opendous_execute_queue(void)
static int opendous_init(void) static int opendous_init(void)
{ {
int check_cnt; int check_cnt;
struct opendous_probe *cur_opendous_probe;
cur_opendous_probe = opendous_probes;
if (opendous_type == NULL) {
opendous_type = strdup("opendous");
LOG_WARNING("No opendous_type specified, using default 'opendous'");
}
while (cur_opendous_probe->name) {
if (strcmp(cur_opendous_probe->name, opendous_type) == 0) {
opendous_probe = cur_opendous_probe;
break;
}
cur_opendous_probe++;
}
if (!opendous_probe) {
LOG_ERROR("No matching cable found for %s", opendous_type);
return ERROR_JTAG_INIT_FAILED;
}
usb_in_buffer = malloc(opendous_probe->BUFFERSIZE);
usb_out_buffer = malloc(opendous_probe->BUFFERSIZE);
pending_scan_results_buffer = (struct pending_scan_result *)
malloc(MAX_PENDING_SCAN_RESULTS * sizeof(struct pending_scan_result));
opendous_jtag_handle = opendous_usb_open(); opendous_jtag_handle = opendous_usb_open();
@ -303,6 +382,27 @@ static int opendous_init(void)
static int opendous_quit(void) static int opendous_quit(void)
{ {
opendous_usb_close(opendous_jtag_handle); opendous_usb_close(opendous_jtag_handle);
if (usb_out_buffer) {
free(usb_out_buffer);
usb_out_buffer = NULL;
}
if (usb_in_buffer) {
free(usb_in_buffer);
usb_in_buffer = NULL;
}
if (pending_scan_results_buffer) {
free(pending_scan_results_buffer);
pending_scan_results_buffer = NULL;
}
if (opendous_type) {
free(opendous_type);
opendous_type = NULL;
}
return ERROR_OK; return ERROR_OK;
} }
@ -461,16 +561,6 @@ static int tap_length;
static uint8_t tms_buffer[OPENDOUS_TAP_BUFFER_SIZE]; static uint8_t tms_buffer[OPENDOUS_TAP_BUFFER_SIZE];
static uint8_t tdo_buffer[OPENDOUS_TAP_BUFFER_SIZE]; static uint8_t tdo_buffer[OPENDOUS_TAP_BUFFER_SIZE];
struct pending_scan_result {
int first; /* First bit position in tdo_buffer to read */
int length; /* Number of bits to read */
struct scan_command *command; /* Corresponding scan command */
uint8_t *buffer;
};
static int pending_scan_results_length;
static struct pending_scan_result pending_scan_results_buffer[MAX_PENDING_SCAN_RESULTS];
static int last_tms; static int last_tms;
void opendous_tap_init(void) void opendous_tap_init(void)
@ -622,7 +712,7 @@ struct opendous_jtag *opendous_usb_open(void)
struct opendous_jtag *result; struct opendous_jtag *result;
struct jtag_libusb_device_handle *devh; struct jtag_libusb_device_handle *devh;
if (jtag_libusb_open(vids, pids, &devh) != ERROR_OK) if (jtag_libusb_open(opendous_probe->VID, opendous_probe->PID, &devh) != ERROR_OK)
return NULL; return NULL;
jtag_libusb_set_configuration(devh, 0); jtag_libusb_set_configuration(devh, 0);
@ -672,8 +762,14 @@ int opendous_usb_write(struct opendous_jtag *opendous_jtag, int out_length)
#ifdef _DEBUG_USB_COMMS_ #ifdef _DEBUG_USB_COMMS_
LOG_DEBUG("%s: USB write begin", opendous_get_time(time_str)); LOG_DEBUG("%s: USB write begin", opendous_get_time(time_str));
#endif #endif
result = jtag_libusb_bulk_write(opendous_jtag->usb_handle, OPENDOUS_WRITE_ENDPOINT, \ if (opendous_probe->CONTROL_TRANSFER) {
(char *)usb_out_buffer, out_length, OPENDOUS_USB_TIMEOUT); result = jtag_libusb_control_transfer(opendous_jtag->usb_handle,
LIBUSB_REQUEST_TYPE_VENDOR | LIBUSB_RECIPIENT_DEVICE | LIBUSB_ENDPOINT_OUT,
FUNC_WRITE_DATA, 0, 0, (char *) usb_out_buffer, out_length, OPENDOUS_USB_TIMEOUT);
} else {
result = jtag_libusb_bulk_write(opendous_jtag->usb_handle, OPENDOUS_WRITE_ENDPOINT, \
(char *)usb_out_buffer, out_length, OPENDOUS_USB_TIMEOUT);
}
#ifdef _DEBUG_USB_COMMS_ #ifdef _DEBUG_USB_COMMS_
LOG_DEBUG("%s: USB write end: %d bytes", opendous_get_time(time_str), result); LOG_DEBUG("%s: USB write end: %d bytes", opendous_get_time(time_str), result);
#endif #endif
@ -692,8 +788,15 @@ int opendous_usb_read(struct opendous_jtag *opendous_jtag)
#ifdef _DEBUG_USB_COMMS_ #ifdef _DEBUG_USB_COMMS_
LOG_DEBUG("%s: USB read begin", opendous_get_time(time_str)); LOG_DEBUG("%s: USB read begin", opendous_get_time(time_str));
#endif #endif
int result = jtag_libusb_bulk_read(opendous_jtag->usb_handle, OPENDOUS_READ_ENDPOINT, int result;
(char *)usb_in_buffer, OPENDOUS_IN_BUFFER_SIZE, OPENDOUS_USB_TIMEOUT); if (opendous_probe->CONTROL_TRANSFER) {
result = jtag_libusb_control_transfer(opendous_jtag->usb_handle,
LIBUSB_REQUEST_TYPE_VENDOR | LIBUSB_RECIPIENT_DEVICE | LIBUSB_ENDPOINT_IN,
FUNC_READ_DATA, 0, 0, (char *) usb_in_buffer, OPENDOUS_IN_BUFFER_SIZE, OPENDOUS_USB_TIMEOUT);
} else {
result = jtag_libusb_bulk_read(opendous_jtag->usb_handle, OPENDOUS_READ_ENDPOINT,
(char *)usb_in_buffer, OPENDOUS_IN_BUFFER_SIZE, OPENDOUS_USB_TIMEOUT);
}
#ifdef _DEBUG_USB_COMMS_ #ifdef _DEBUG_USB_COMMS_
LOG_DEBUG("%s: USB read end: %d bytes", opendous_get_time(time_str), result); LOG_DEBUG("%s: USB read end: %d bytes", opendous_get_time(time_str), result);
#endif #endif