X-Git-Url: https://review.openocd.org/gitweb?a=blobdiff_plain;f=src%2Fjtag%2Fpresto.c;h=01cf08a1a902b4096469e7862a9b396566a2a4d0;hb=e378eeec3634e921405acb0cb86bde4cf53a76d7;hp=62a9746b2f208c2241c149fcfe31d14c2e4d2c52;hpb=b930514e2f3e2a83e075e8c19ae0d38bbd2b27dc;p=openocd.git

diff --git a/src/jtag/presto.c b/src/jtag/presto.c
index 62a9746b2f..01cf08a1a9 100644
--- a/src/jtag/presto.c
+++ b/src/jtag/presto.c
@@ -49,6 +49,8 @@
 #include <ftd2xx.h>
 #elif BUILD_PRESTO_LIBFTDI == 1
 #include <ftdi.h>
+#else
+#error "BUG: either FTD2XX and LIBFTDI has to be used"
 #endif
 
 
@@ -61,7 +63,6 @@ jtag_interface_t presto_interface =
 {
 	.name = "presto",
 	.execute_queue = bitq_execute_queue,
-	.support_pathmove = 1,
 	.speed = presto_jtag_speed,
 	.register_commands = presto_jtag_register_commands,
 	.init = presto_jtag_init,
@@ -108,7 +109,7 @@ typedef struct presto_s
 	struct ftdi_context ftdic;
 	int retval;
 #endif
-	
+
 	char serial[FT_DEVICE_SERNUM_LEN];
 
 	u8 buff_out[BUFFER_SIZE];
@@ -138,76 +139,74 @@ u8 presto_init_seq[] =
 	0x80, 0xA0, 0xA8, 0xB0, 0xC0, 0xE0
 };
 
-int presto_write(u8 *buf, int size, u32* bytes_written)
+int presto_write(u8 *buf, int size)
 {
 #if BUILD_PRESTO_FTD2XX == 1
-	DWORD dw_bytes_written;
-	if ((presto->status = FT_Write(presto->handle, buf, size, &dw_bytes_written)) != FT_OK)
+	DWORD ftbytes;
+	if ((presto->status = FT_Write(presto->handle, buf, size, &ftbytes)) != FT_OK)
 	{
-		*bytes_written = dw_bytes_written;
 		ERROR("FT_Write returned: %lu", presto->status);
 		return ERROR_JTAG_DEVICE_ERROR;
 	}
-	else
-	{
-		*bytes_written = dw_bytes_written;
-		return ERROR_OK;	
-	}
+
 #elif BUILD_PRESTO_LIBFTDI == 1
+	u32 ftbytes;
 	if ((presto->retval = ftdi_write_data(&presto->ftdic, buf, size)) < 0)
 	{
-		*bytes_written = 0;
 		ERROR("ftdi_write_data: %s", ftdi_get_error_string(&presto->ftdic));
 		return ERROR_JTAG_DEVICE_ERROR;
 	}
-	else
+	ftbytes = presto->retval;
+#endif
+
+	if (ftbytes != size)
 	{
-		*bytes_written = retval;
-		return ERROR_OK;	
+		ERROR("couldn't write the requested number of bytes to PRESTO (%i < %i)", ftbytes, size);
+		return ERROR_JTAG_DEVICE_ERROR;
 	}
-#endif
+
+	return ERROR_OK;
 }
 
-int presto_read(u8* buf, int size, u32* bytes_read)
+int presto_read(u8* buf, int size)
 {
 #if BUILD_PRESTO_FTD2XX == 1
-	DWORD dw_bytes_read;
-	int timeout = 5;
-	*bytes_read = 0;
-
-	while ((*bytes_read < size) && timeout--)
+	DWORD ftbytes;
+	if ((presto->status = FT_Read(presto->handle, buf, size, &ftbytes)) != FT_OK)
 	{
-		if ((presto->status = FT_Read(presto->handle, buf + *bytes_read, size - 
-			*bytes_read, &dw_bytes_read)) != FT_OK)		
-		{
-			*bytes_read = 0; 
-			ERROR("FT_Read returned: %lu", presto->status);
-			return ERROR_JTAG_DEVICE_ERROR;
-		}
-		*bytes_read += dw_bytes_read; 
+		ERROR("FT_Read returned: %lu", presto->status);
+		return ERROR_JTAG_DEVICE_ERROR;
 	}
+
 #elif BUILD_PRESTO_LIBFTDI == 1
-	int timeout = 100;
-	*bytes_read = 0;
-	
-	while ((*bytes_read < size) && timeout--)
+	u32 ftbytes = 0;
+
+	struct timeval timeout, now;
+	gettimeofday(&timeout, NULL);
+	timeval_add_time(&timeout, 1, 0); /* one second timeout */
+
+	while (ftbytes < size)
 	{
-		if ((presto->retval = ftdi_read_data(&presto->ftdic, buf + *bytes_read, size - *bytes_read)) < 0)
+		if ((presto->retval = ftdi_read_data(&presto->ftdic, buf + ftbytes, size - ftbytes)) < 0)
 		{
-			*bytes_read = 0;
 			ERROR("ftdi_read_data: %s", ftdi_get_error_string(&presto->ftdic));
 			return ERROR_JTAG_DEVICE_ERROR;
 		}
-		*bytes_read += retval;
+		ftbytes += presto->retval;
+
+		gettimeofday(&now, NULL);
+		if ((now.tv_sec > timeout.tv_sec) || ((now.tv_sec == timeout.tv_sec) && (now.tv_usec > timeout.tv_usec)))
+			break;
 	}
 #endif
 
-	if (*bytes_read < size)
+	if (ftbytes != size)
 	{
-		ERROR("couldn't read the requested number of bytes from PRESTO (%i < %i)", *bytes_read, size);
+		/* this is just a warning, there might have been timeout when detecting PRESTO, which is not fatal */
+		WARNING("couldn't read the requested number of bytes from PRESTO (%i < %i)", ftbytes, size);
 		return ERROR_JTAG_DEVICE_ERROR;
 	}
-	
+
 	return ERROR_OK;
 }
 
@@ -221,10 +220,10 @@ int presto_open_ftd2xx(char *req_serial)
 	FT_DEVICE device;
 
 	BYTE presto_data;
-	unsigned long ftbytes;
+	DWORD ftbytes;
 
 	presto->handle = (FT_HANDLE)INVALID_HANDLE_VALUE;
-	
+
 #if IS_WIN32 == 0
 	/* Add non-standard Vid/Pid to the linux driver */
 	if ((presto->status = FT_SetVIDPID(PRESTO_VID, PRESTO_PID)) != FT_OK)
@@ -237,82 +236,106 @@ int presto_open_ftd2xx(char *req_serial)
 	if ((presto->status = FT_ListDevices(&numdevs, NULL, FT_LIST_NUMBER_ONLY)) != FT_OK)
 	{
 		ERROR("FT_ListDevices failed: %i", (int)presto->status);
-		return ERROR_JTAG_INIT_FAILED;
+		return ERROR_JTAG_DEVICE_ERROR;
 	}
-	
+
+	DEBUG("FTDI devices available: %i", numdevs);
 	for (i = 0; i < numdevs; i++)
 	{
-		if (FT_Open(i, &(presto->handle)) != FT_OK)
+		if ((presto->status = FT_Open(i, &(presto->handle))) != FT_OK)
 		{
-			ERROR("FT_Open failed: %i", (int)presto->status);
+			/* this is not fatal, the device may be legitimately open by other process, hence debug message only */
+			DEBUG("FT_Open failed: %i", (int)presto->status);
 			continue;
 		}
-			
-		if (FT_GetDeviceInfo(presto->handle, &device, &vidpid,
-				presto->serial, devname, NULL) == FT_OK)
+		DEBUG("FTDI device %i open", i);
+
+		if ((presto->status = FT_GetDeviceInfo(presto->handle, &device, &vidpid,
+				presto->serial, devname, NULL)) == FT_OK)
 		{
 			if (vidpid == PRESTO_VID_PID
 					&& (req_serial == NULL || !strcmp(presto->serial, req_serial)))
 				break;
 		}
-		
+		else
+			DEBUG("FT_GetDeviceInfo failed: %i", presto->status);
+
+		DEBUG("FTDI device %i does not match, closing", i);
 		FT_Close(presto->handle);
 		presto->handle = (FT_HANDLE)INVALID_HANDLE_VALUE;
 	}
 
 	if (presto->handle == (FT_HANDLE)INVALID_HANDLE_VALUE)
-		return ERROR_JTAG_INIT_FAILED;
+		return ERROR_JTAG_DEVICE_ERROR; /* presto not open, return */
+
 	if ((presto->status = FT_SetLatencyTimer(presto->handle, 1)) != FT_OK)
-		return ERROR_JTAG_INIT_FAILED;
+		return ERROR_JTAG_DEVICE_ERROR;
+
+
 	if ((presto->status = FT_SetTimeouts(presto->handle, 100, 0)) != FT_OK)
-		return ERROR_JTAG_INIT_FAILED;
+		return ERROR_JTAG_DEVICE_ERROR;
+
 	if ((presto->status = FT_Purge(presto->handle, FT_PURGE_TX | FT_PURGE_RX)) != FT_OK)
-		return ERROR_JTAG_INIT_FAILED;
+		return ERROR_JTAG_DEVICE_ERROR;
 
 	presto_data = 0xD0;
 	if ((presto->status = FT_Write(presto->handle, &presto_data, 1, &ftbytes)) != FT_OK)
-		return ERROR_JTAG_INIT_FAILED;
+		return ERROR_JTAG_DEVICE_ERROR;
+
+	/* delay between first write/read turnaround (after purge?) necessary under Linux for unknown reason,
+	   probably a bug in library threading */
+	usleep(100000);
 	if ((presto->status = FT_Read(presto->handle, &presto_data, 1, &ftbytes)) != FT_OK)
-		return ERROR_JTAG_INIT_FAILED;
+		return ERROR_JTAG_DEVICE_ERROR;
 
 	if (ftbytes!=1)
 	{
-		if ((presto->status = FT_SetBitMode(presto->handle, 0x80, 1)) != FT_OK)
-			return ERROR_JTAG_INIT_FAILED;
+		DEBUG("PRESTO reset");
+
 		if ((presto->status = FT_Purge(presto->handle, FT_PURGE_TX | FT_PURGE_RX)) != FT_OK)
-			return ERROR_JTAG_INIT_FAILED ;
+			return ERROR_JTAG_DEVICE_ERROR;
+		if ((presto->status = FT_SetBitMode(presto->handle, 0x80, 1)) != FT_OK)
+			return ERROR_JTAG_DEVICE_ERROR;
 		if ((presto->status = FT_SetBaudRate(presto->handle, 9600)) != FT_OK)
-			return ERROR_JTAG_INIT_FAILED;
+			return ERROR_JTAG_DEVICE_ERROR;
 
 		presto_data = 0;
 		for (i = 0; i < 4 * 62; i++)
 			if ((presto->status=FT_Write(presto->handle, &presto_data, 1, &ftbytes)) != FT_OK)
-				return ERROR_JTAG_INIT_FAILED;
+				return ERROR_JTAG_DEVICE_ERROR;
 
 		usleep(100000);
 
 		if ((presto->status = FT_SetBitMode(presto->handle, 0x00, 0)) != FT_OK)
-			return ERROR_JTAG_INIT_FAILED;
+			return ERROR_JTAG_DEVICE_ERROR;
+
 		if ((presto->status = FT_Purge(presto->handle, FT_PURGE_TX | FT_PURGE_RX)) != FT_OK)
-			return ERROR_JTAG_INIT_FAILED;
+			return ERROR_JTAG_DEVICE_ERROR;
 
 		presto_data = 0xD0;
 		if ((presto->status = FT_Write(presto->handle, &presto_data, 1, &ftbytes)) != FT_OK)
-			return ERROR_JTAG_INIT_FAILED;
+			return ERROR_JTAG_DEVICE_ERROR;
+
+		/* delay between first write/read turnaround (after purge?) necessary under Linux for unknown reason,
+		   probably a bug in library threading */
+		usleep(100000);
 		if ((presto->status = FT_Read(presto->handle, &presto_data, 1, &ftbytes)) != FT_OK)
-			return ERROR_JTAG_INIT_FAILED;
+			return ERROR_JTAG_DEVICE_ERROR;
+
 		if (ftbytes!=1)
-			return ERROR_JTAG_INIT_FAILED;
+		{
+			DEBUG("PRESTO not responding");
+			return ERROR_JTAG_DEVICE_ERROR;
+		}
 	}
 
 	if ((presto->status = FT_SetTimeouts(presto->handle, 0, 0)) != FT_OK)
-		return ERROR_JTAG_INIT_FAILED;
+		return ERROR_JTAG_DEVICE_ERROR;
+
 
 	presto->status = FT_Write(presto->handle, &presto_init_seq, sizeof(presto_init_seq), &ftbytes);
-	if (presto->status != FT_OK)
-		return ERROR_JTAG_INIT_FAILED;
-	if (ftbytes != sizeof(presto_init_seq))
-		return ERROR_JTAG_INIT_FAILED;
+	if (presto->status != FT_OK || ftbytes != sizeof(presto_init_seq))
+		return ERROR_JTAG_DEVICE_ERROR;
 
 	return ERROR_OK;
 }
@@ -321,41 +344,72 @@ int presto_open_ftd2xx(char *req_serial)
 int presto_open_libftdi(char *req_serial)
 {
 	u8 presto_data;
-	u32 ftbytes;
-		
-	DEBUG("searching for presto JTAG interface using libftdi");
+
+	DEBUG("searching for PRESTO using libftdi");
+
+	/* initialize FTDI context structure */
+	if (ftdi_init(&presto->ftdic) < 0)
+	{
+		ERROR("unable to init libftdi: %s", presto->ftdic.error_str);
+		return ERROR_JTAG_DEVICE_ERROR;
+	}
 
 	/* context, vendor id, product id */
 	if (ftdi_usb_open_desc(&presto->ftdic, PRESTO_VID, PRESTO_PID, NULL, req_serial) < 0)
 	{
-		ERROR("unable to open presto: %s", presto->ftdic.error_str);
-		return ERROR_JTAG_INIT_FAILED;
+		ERROR("unable to open PRESTO: %s", presto->ftdic.error_str);
+		return ERROR_JTAG_DEVICE_ERROR;
 	}
-	
+
 	if (ftdi_usb_reset(&presto->ftdic) < 0)
 	{
-		ERROR("unable to reset presto device");
-		return ERROR_JTAG_INIT_FAILED;
+		ERROR("unable to reset PRESTO device");
+		return ERROR_JTAG_DEVICE_ERROR;
 	}
 
 	if (ftdi_set_latency_timer(&presto->ftdic, 1) < 0)
 	{
 		ERROR("unable to set latency timer");
-		return ERROR_JTAG_INIT_FAILED;
+		return ERROR_JTAG_DEVICE_ERROR;
 	}
 
 	if (ftdi_usb_purge_buffers(&presto->ftdic) < 0)
 	{
-		ERROR("unable to purge presto buffer");
-		return ERROR_JTAG_INIT_FAILED;
+		ERROR("unable to purge PRESTO buffers");
+		return ERROR_JTAG_DEVICE_ERROR;
 	}
-	
+
 	presto_data = 0xD0;
-	if ((presto->retval = presto_write(&presto_data, 1, &ftbytes)) != ERROR_OK)
-		return ERROR_JTAG_INIT_FAILED;
-	if ((presto->retval = presto_read(&presto_data, 1, &ftbytes)) != ERROR_OK)
-		return ERROR_JTAG_INIT_FAILED;
-	
+	if (presto_write(&presto_data, 1) != ERROR_OK)
+	{
+		ERROR("error writing to PRESTO");
+		return ERROR_JTAG_DEVICE_ERROR;
+	}
+
+	if (presto_read(&presto_data, 1) != ERROR_OK)
+	{
+		DEBUG("no response from PRESTO, retrying");
+
+		if (ftdi_usb_purge_buffers(&presto->ftdic) < 0)
+			return ERROR_JTAG_DEVICE_ERROR;
+
+		presto_data = 0xD0;
+		if (presto_write(&presto_data, 1) != ERROR_OK)
+			return ERROR_JTAG_DEVICE_ERROR;
+
+		if (presto_read(&presto_data, 1) != ERROR_OK)
+		{
+			ERROR("no response from PRESTO, giving up");
+			return ERROR_JTAG_DEVICE_ERROR;
+		}
+	}
+
+	if (presto_write(presto_init_seq, sizeof(presto_init_seq)) != ERROR_OK)
+	{
+		ERROR("error writing PRESTO init sequence");
+		return ERROR_JTAG_DEVICE_ERROR;
+	}
+
 	return ERROR_OK;
 }
 #endif /* BUILD_PRESTO_LIBFTDI == 1 */
@@ -387,40 +441,40 @@ int presto_close(void)
 
 	int result = ERROR_OK;
 
-#if BUID_PRESTO_FTD2XX == 1
+#if BUILD_PRESTO_FTD2XX == 1
 	unsigned long ftbytes;
 
 	if (presto->handle == (FT_HANDLE)INVALID_HANDLE_VALUE)
 		return result;
 
-	presto->status = FT_Write(presto->handle, &presto_init_seq, sizeof(presto_init_seq), &ftbytes);
+	presto->status = FT_Purge(presto->handle, FT_PURGE_TX | FT_PURGE_RX);
 	if (presto->status != FT_OK)
-		result = PRST_ERR;
-	if (ftbytes != sizeof(presto_init_seq))
-		result = PRST_TIMEOUT;
+		result = ERROR_JTAG_DEVICE_ERROR;
+
+	presto->status = FT_Write(presto->handle, &presto_init_seq, sizeof(presto_init_seq), &ftbytes);
+	if (presto->status != FT_OK || ftbytes != sizeof(presto_init_seq))
+		result = ERROR_JTAG_DEVICE_ERROR;
 
 	if ((presto->status = FT_SetLatencyTimer(presto->handle, 16)) != FT_OK)
-		result = PRST_ERR;
+		result = ERROR_JTAG_DEVICE_ERROR;
 
 	if ((presto->status = FT_Close(presto->handle)) != FT_OK)
-		result = PRST_ERR;
+		result = ERROR_JTAG_DEVICE_ERROR;
 	else
 		presto->handle = (FT_HANDLE)INVALID_HANDLE_VALUE;
-	
+
 #elif BUILD_PRESTO_LIBFTDI == 1
-	
-	if ((presto->retval = ftdi_write_data(&presto->ftdic, presto_init_seq, sizeof(presto_init_seq))) < 0)
-	{
+
+	if ((presto->retval = ftdi_write_data(&presto->ftdic, presto_init_seq, sizeof(presto_init_seq))) != sizeof(presto_init_seq))
 		result = ERROR_JTAG_DEVICE_ERROR;
-	}
-	
+
 	if ((presto->retval = ftdi_set_latency_timer(&presto->ftdic, 16)) < 0)
-	{
 		result = ERROR_JTAG_DEVICE_ERROR;
-	}
-	
-	ftdi_deinit(&presto->ftdic);
-	
+
+	if ((presto->retval = ftdi_usb_close(&presto->ftdic)) < 0)
+		result = ERROR_JTAG_DEVICE_ERROR;
+	else
+		ftdi_deinit(&presto->ftdic);
 #endif
 
 	return result;
@@ -429,33 +483,26 @@ int presto_close(void)
 
 int presto_flush(void)
 {
-	u32 ftbytes;
-
 	if (presto->buff_out_pos == 0)
 		return ERROR_OK;
 
 #if BUILD_PRESTO_FTD2XX == 1
 	if (presto->status != FT_OK)
 #elif BUILD_PRESTO_LIBFTDI == 1
-	if (presto->retval != ERROR_OK)
+	if (presto->retval < 0)
 #endif
-		return ERROR_JTAG_DEVICE_ERROR;
-
-
-	if (presto_write(presto->buff_out, presto->buff_out_pos, &ftbytes) != ERROR_OK)
 	{
-		presto->buff_out_pos = 0;
+		DEBUG("error in previous communication, canceling I/O operation");
 		return ERROR_JTAG_DEVICE_ERROR;
 	}
 
-	presto->total_out += ftbytes;
-
-	if (presto->buff_out_pos != ftbytes)
+	if (presto_write(presto->buff_out, presto->buff_out_pos) != ERROR_OK)
 	{
 		presto->buff_out_pos = 0;
 		return ERROR_JTAG_DEVICE_ERROR;
 	}
 
+	presto->total_out += presto->buff_out_pos;
 	presto->buff_out_pos = 0;
 
 	if (presto->buff_in_exp == 0)
@@ -464,20 +511,13 @@ int presto_flush(void)
 	presto->buff_in_pos = 0;
 	presto->buff_in_len = 0;
 
-	if (presto_read(presto->buff_in, presto->buff_in_exp, &ftbytes) != ERROR_OK)
-	{
-		presto->buff_in_exp = 0;
-		return ERROR_JTAG_DEVICE_ERROR;
-	}
-
-	presto->total_in += ftbytes;
-
-	if (ftbytes != presto->buff_in_exp)
+	if (presto_read(presto->buff_in, presto->buff_in_exp) != ERROR_OK)
 	{
 		presto->buff_in_exp = 0;
 		return ERROR_JTAG_DEVICE_ERROR;
 	}
 
+	presto->total_in += presto->buff_in_exp;
 	presto->buff_in_len = presto->buff_in_exp;
 	presto->buff_in_exp = 0;
 
@@ -498,9 +538,14 @@ int presto_sendbyte(int data)
 	else
 		return ERROR_JTAG_DEVICE_ERROR;
 
+#if BUILD_PRESTO_FTD2XX == 1
 	if (presto->buff_out_pos >= BUFFER_SIZE)
+#elif BUILD_PRESTO_LIBFTDI == 1
+	/* libftdi does not do background read, be sure that USB IN buffer does not overflow (128 bytes only!) */
+	if (presto->buff_out_pos >= BUFFER_SIZE || presto->buff_in_exp==128)
+#endif
 		return presto_flush();
-	
+
 	return ERROR_OK;
 }
 
@@ -512,7 +557,7 @@ int presto_getbyte(void)
 
 	if (presto->buff_in_exp == 0)
 		return -1;
-	
+
 	if (presto_flush() != ERROR_OK)
 		return -1;
 
@@ -542,7 +587,7 @@ int presto_bitq_out(int tms, int tdi, int tdo_req)
 			presto->jtag_tdi_data = (tdi != 0);
 		else
 			presto->jtag_tdi_data |= (tdi != 0) << presto->jtag_tdi_count;
-		
+
 		if (++presto->jtag_tdi_count == 4)
 		{
 			presto->jtag_tdi_data |= (presto->jtag_tdi_count - 1) << 4;
@@ -718,10 +763,10 @@ int presto_jtag_init(void)
 		return ERROR_JTAG_INIT_FAILED;
 	}
 	INFO("PRESTO open, serial number '%s'", presto->serial);
-	
+
 	/* use JTAG speed setting from configuration file */
 	presto_jtag_speed(jtag_speed);
-	
+
 	bitq_interface = &presto_bitq;
 	return ERROR_OK;
 }