1 |
// Include FTDI library |
1 |
// Include FTDI library |
2 |
#include "mlab_xvcd_port_FTDI.h" |
2 |
#include "mlab_xvcd_port_FTDI.h" |
3 |
|
3 |
|
4 |
#ifdef WIN32 |
4 |
#ifdef WIN32 |
5 |
|
5 |
|
6 |
#include <windows.h> // Windows Console Application (Sleep) |
6 |
#include <windows.h> // Windows Console Application (Sleep) |
7 |
|
7 |
|
8 |
#else |
8 |
#else |
9 |
|
9 |
|
10 |
#include <unistd.h> // sleep |
10 |
#include <unistd.h> // sleep |
11 |
|
11 |
|
12 |
#endif |
12 |
#endif |
13 |
|
13 |
|
14 |
// JTAG Output Pin Mask |
14 |
// JTAG Output Pin Mask |
15 |
#define IO_OUTPUT_MASK (PORT_TCK|PORT_TDI|PORT_TMS|PORT_LED) // Mask for all Output Pins |
15 |
#define IO_OUTPUT_MASK (PORT_TCK|PORT_TDI|PORT_TMS|PORT_LED) // Mask for all Output Pins |
16 |
|
16 |
|
17 |
|
17 |
|
18 |
// Global Variables |
18 |
// Global Variables |
19 |
FT_HANDLE ftHandle; // Handle for FTDI device |
19 |
FT_HANDLE ftHandle; // Handle for FTDI device |
20 |
bool ftHandleValid = false; // Valid Handle |
20 |
bool ftHandleValid = false; // Valid Handle |
21 |
unsigned char PinStatus = 0; // Status of DBUS pins |
21 |
unsigned char PinStatus = 0; // Status of DBUS pins |
22 |
unsigned char LedMask = 0; // LED Mask for DBUS data transfer |
22 |
unsigned char LedMask = 0; // LED Mask for DBUS data transfer |
23 |
|
23 |
|
24 |
|
24 |
|
25 |
// Convert string to int (both decimal and hex string) |
25 |
// Convert string to int (both decimal and hex string) |
26 |
int atoiEx(char *s) |
26 |
int atoiEx(char *s) |
27 |
{ |
27 |
{ |
28 |
if (s[0]=='0' && (s[1]=='x' || s[1]=='X')) |
28 |
if (s[0]=='0' && (s[1]=='x' || s[1]=='X')) |
29 |
{ |
29 |
{ |
30 |
// Hex Value |
30 |
// Hex Value |
31 |
int i; |
31 |
int i; |
32 |
#pragma warning(disable: 4996) // Disable MS warning about scanf |
32 |
#pragma warning(disable: 4996) // Disable MS warning about scanf |
33 |
sscanf(s, "%x", &i); |
33 |
sscanf(s, "%x", &i); |
34 |
return i; |
34 |
return i; |
35 |
} |
35 |
} |
36 |
else |
36 |
else |
37 |
{ |
37 |
{ |
38 |
// Decimal Value |
38 |
// Decimal Value |
39 |
return atoi(s); |
39 |
return atoi(s); |
40 |
} |
40 |
} |
41 |
} |
41 |
} |
42 |
|
42 |
|
43 |
|
43 |
|
44 |
// Print FTDI Pin Names (from mask value) |
44 |
// Print FTDI Pin Names (from mask value) |
45 |
void jtagPrintPinNames(int pinMask) |
45 |
void jtagPrintPinNames(int pinMask) |
46 |
{ |
46 |
{ |
47 |
// 16bit (MSB is CBUS, LSB is DBUS) |
47 |
// 16bit (MSB is CBUS, LSB is DBUS) |
48 |
int bit=15; |
48 |
int bit=15; |
49 |
bool useDelimiter=false; |
49 |
bool useDelimiter=false; |
50 |
|
50 |
|
51 |
do |
51 |
do |
52 |
{ |
52 |
{ |
53 |
int mask = 1 << bit; |
53 |
int mask = 1 << bit; |
54 |
if (pinMask & mask) |
54 |
if (pinMask & mask) |
55 |
{ |
55 |
{ |
56 |
if (useDelimiter) |
56 |
if (useDelimiter) |
57 |
{ |
57 |
{ |
58 |
printf("+"); |
58 |
printf("+"); |
59 |
} |
59 |
} |
60 |
if (bit > 7) |
60 |
if (bit > 7) |
61 |
{ |
61 |
{ |
62 |
printf("CBUS%c", '0' + bit - 8); |
62 |
printf("CBUS%c", '0' + bit - 8); |
63 |
} |
63 |
} |
64 |
else |
64 |
else |
65 |
{ |
65 |
{ |
66 |
printf("DBUS%c", '0' + bit); |
66 |
printf("DBUS%c", '0' + bit); |
67 |
switch (mask) |
67 |
switch (mask) |
68 |
{ |
68 |
{ |
69 |
case FTDI_TXD: printf("(TXD)"); break; |
69 |
case FTDI_TXD: printf("(TXD)"); break; |
70 |
case FTDI_RXD: printf("(RXD)"); break; |
70 |
case FTDI_RXD: printf("(RXD)"); break; |
71 |
case FTDI_RTS: printf("(RTS)"); break; |
71 |
case FTDI_RTS: printf("(RTS)"); break; |
72 |
case FTDI_CTS: printf("(CTS)"); break; |
72 |
case FTDI_CTS: printf("(CTS)"); break; |
73 |
case FTDI_DTR: printf("(DTR)"); break; |
73 |
case FTDI_DTR: printf("(DTR)"); break; |
74 |
case FTDI_DSR: printf("(DSR)"); break; |
74 |
case FTDI_DSR: printf("(DSR)"); break; |
75 |
case FTDI_DCD: printf("(DCD)"); break; |
75 |
case FTDI_DCD: printf("(DCD)"); break; |
76 |
case FTDI_RI: printf("(RI) "); break; |
76 |
case FTDI_RI: printf("(RI) "); break; |
77 |
} |
77 |
} |
78 |
} |
78 |
} |
79 |
useDelimiter = true; |
79 |
useDelimiter = true; |
80 |
} |
80 |
} |
81 |
} |
81 |
} |
82 |
while (bit-- > 0); |
82 |
while (bit-- > 0); |
83 |
} |
83 |
} |
84 |
|
84 |
|
85 |
|
85 |
|
86 |
// Verify pin usage |
86 |
// Verify pin usage |
87 |
void jtagCheckPinConfig() |
87 |
void jtagCheckPinConfig() |
88 |
{ |
88 |
{ |
89 |
// Check CBUS usage |
89 |
// Check CBUS usage |
90 |
if ( PORT_TCK > 0x00FF ) |
90 |
if ( PORT_TCK > 0x00FF ) |
91 |
fprintf(stderr, "\nFTDI: INTERNAL ERROR: TCK can't use CBUS signal"), exit(2); |
91 |
fprintf(stderr, "\nFTDI: INTERNAL ERROR: TCK can't use CBUS signal"), exit(2); |
92 |
if ( PORT_TCK == 0 ) |
92 |
if ( PORT_TCK == 0 ) |
93 |
fprintf(stderr, "\nFTDI: INTERNAL ERROR: TCK not defined"), exit(2); |
93 |
fprintf(stderr, "\nFTDI: INTERNAL ERROR: TCK not defined"), exit(2); |
94 |
|
94 |
|
95 |
if ( PORT_TDI > 0x00FF ) |
95 |
if ( PORT_TDI > 0x00FF ) |
96 |
fprintf(stderr, "\nFTDI: INTERNAL ERROR: TDI can't use CBUS signal"), exit(2); |
96 |
fprintf(stderr, "\nFTDI: INTERNAL ERROR: TDI can't use CBUS signal"), exit(2); |
97 |
if ( PORT_TDI == 0 ) |
97 |
if ( PORT_TDI == 0 ) |
98 |
fprintf(stderr, "\nFTDI: INTERNAL ERROR: TDI not defined"), exit(2); |
98 |
fprintf(stderr, "\nFTDI: INTERNAL ERROR: TDI not defined"), exit(2); |
99 |
|
99 |
|
100 |
if ( PORT_TDO > 0x00FF ) |
100 |
if ( PORT_TDO > 0x00FF ) |
101 |
fprintf(stderr, "\nFTDI: INTERNAL ERROR: TDO can't use CBUS signal"), exit(2); |
101 |
fprintf(stderr, "\nFTDI: INTERNAL ERROR: TDO can't use CBUS signal"), exit(2); |
102 |
if ( PORT_TDO == 0 ) |
102 |
if ( PORT_TDO == 0 ) |
103 |
fprintf(stderr, "\nFTDI: INTERNAL ERROR: TDO not defined"), exit(2); |
103 |
fprintf(stderr, "\nFTDI: INTERNAL ERROR: TDO not defined"), exit(2); |
104 |
|
104 |
|
105 |
if ( PORT_TMS > 0x00FF) |
105 |
if ( PORT_TMS > 0x00FF) |
106 |
fprintf(stderr, "\nFTDI: INTERNAL ERROR: TMS can't use CBUS signal"), exit(2); |
106 |
fprintf(stderr, "\nFTDI: INTERNAL ERROR: TMS can't use CBUS signal"), exit(2); |
107 |
if ( PORT_TMS == 0 ) |
107 |
if ( PORT_TMS == 0 ) |
108 |
fprintf(stderr, "\nFTDI: INTERNAL ERROR: TMS not defined"), exit(2); |
108 |
fprintf(stderr, "\nFTDI: INTERNAL ERROR: TMS not defined"), exit(2); |
109 |
|
109 |
|
110 |
if ( PORT_LED > 0x0FFF) |
110 |
if ( PORT_LED > 0x0FFF) |
111 |
fprintf(stderr, "\nFTDI: INTERNAL ERROR: LED can't use CBUS signal > 3"), exit(2); |
111 |
fprintf(stderr, "\nFTDI: INTERNAL ERROR: LED can't use CBUS signal > 3"), exit(2); |
112 |
} |
112 |
} |
113 |
|
113 |
|
114 |
|
114 |
|
115 |
// Print JTAG Pin Assignment |
115 |
// Print JTAG Pin Assignment |
116 |
void jtagPrintPinConfig() |
116 |
void jtagPrintPinConfig() |
117 |
{ |
117 |
{ |
118 |
// Print pin masks human readable |
118 |
// Print pin masks human readable |
119 |
printf(" JTAG Port Pins "); printf("TCK->"); jtagPrintPinNames(PORT_TCK); printf("\n"); |
119 |
printf(" JTAG Port Pins "); printf("TCK->"); jtagPrintPinNames(PORT_TCK); printf("\n"); |
120 |
printf(" "); printf("TDI->"); jtagPrintPinNames(PORT_TDI); printf("\n"); |
120 |
printf(" "); printf("TDI->"); jtagPrintPinNames(PORT_TDI); printf("\n"); |
121 |
printf(" "); printf("TDO->"); jtagPrintPinNames(PORT_TDO); printf("\n"); |
121 |
printf(" "); printf("TDO->"); jtagPrintPinNames(PORT_TDO); printf("\n"); |
122 |
printf(" "); printf("TMS->"); jtagPrintPinNames(PORT_TMS); printf("\n"); |
122 |
printf(" "); printf("TMS->"); jtagPrintPinNames(PORT_TMS); printf("\n"); |
123 |
printf(" "); printf("LED->"); jtagPrintPinNames(PORT_LED); printf("\n"); |
123 |
printf(" "); printf("LED->"); jtagPrintPinNames(PORT_LED); printf("\n"); |
124 |
} |
124 |
} |
125 |
|
125 |
|
126 |
|
126 |
|
127 |
// Connect to FTDI driver |
127 |
// Connect to FTDI driver |
128 |
int jtagOpenPort(int findDeviceBy, char *findDeviceByStr) |
128 |
int jtagOpenPort(int findDeviceBy, char *findDeviceByStr) |
129 |
{ |
129 |
{ |
130 |
// Enumerate FTDI Devices |
130 |
// Enumerate FTDI Devices |
131 |
// ---------------------- |
131 |
// ---------------------- |
132 |
|
132 |
|
133 |
FT_STATUS ftStatus; |
133 |
FT_STATUS ftStatus; |
134 |
|
134 |
|
135 |
// Print Library Version |
135 |
// Print Library Version |
136 |
printf("FTDI Connect\n"); |
136 |
printf("FTDI Connect\n"); |
137 |
DWORD dwLibraryVer; |
137 |
DWORD dwLibraryVer; |
138 |
ftStatus = FT_GetLibraryVersion(&dwLibraryVer); |
138 |
ftStatus = FT_GetLibraryVersion(&dwLibraryVer); |
139 |
if (ftStatus == FT_OK) |
139 |
if (ftStatus == FT_OK) |
140 |
printf(" Library Version 0x%x\n", dwLibraryVer); |
140 |
printf(" Library Version 0x%x\n", dwLibraryVer); |
141 |
else |
141 |
else |
142 |
fprintf(stderr, "\nFTDI: Error Reading Library Version\n"); |
142 |
fprintf(stderr, "\nFTDI: Error Reading Library Version\n"); |
143 |
|
143 |
|
144 |
// Create Device Information List |
144 |
// Create Device Information List |
145 |
DWORD numDevs = 0; |
145 |
DWORD numDevs = 0; |
146 |
ftStatus = FT_CreateDeviceInfoList(&numDevs); |
146 |
ftStatus = FT_CreateDeviceInfoList(&numDevs); |
147 |
if (ftStatus == FT_OK) |
147 |
if (ftStatus == FT_OK) |
148 |
printf(" Devices Found %d\n", numDevs); |
148 |
printf(" Devices Found %d\n", numDevs); |
149 |
else |
149 |
else |
150 |
printf(" No FTDI Device Found\n"); |
150 |
printf(" No FTDI Device Found\n"); |
151 |
|
151 |
|
152 |
if (numDevs==0) |
152 |
if (numDevs==0) |
153 |
return -1; |
153 |
return -1; |
154 |
|
154 |
|
155 |
// Print Config Info |
155 |
// Print Config Info |
156 |
jtagPrintPinConfig(); |
156 |
jtagPrintPinConfig(); |
157 |
jtagCheckPinConfig(); |
157 |
jtagCheckPinConfig(); |
158 |
printf("\n"); |
158 |
printf("\n"); |
159 |
|
159 |
|
160 |
// List All FTDI Devices |
160 |
// List All FTDI Devices |
161 |
FT_HANDLE ftHandleTemp; |
161 |
FT_HANDLE ftHandleTemp; |
162 |
DWORD Flags; |
162 |
DWORD Flags; |
163 |
DWORD ID; |
163 |
DWORD ID; |
164 |
DWORD Type; |
164 |
DWORD Type; |
165 |
DWORD LocId; |
165 |
DWORD LocId; |
166 |
char SerialNumber[16]; |
166 |
char SerialNumber[16]; |
167 |
char Description[64]; |
167 |
char Description[64]; |
168 |
for (DWORD i=0; i<numDevs; i++) |
168 |
for (DWORD i=0; i<numDevs; i++) |
169 |
{ |
169 |
{ |
170 |
ftStatus = FT_GetDeviceInfoDetail(i, &Flags, &Type, &ID, &LocId, SerialNumber, Description, &ftHandleTemp); |
170 |
ftStatus = FT_GetDeviceInfoDetail(i, &Flags, &Type, &ID, &LocId, SerialNumber, Description, &ftHandleTemp); |
171 |
if (ftStatus == FT_OK) |
171 |
if (ftStatus == FT_OK) |
172 |
{ |
172 |
{ |
173 |
printf("Device %d\n", i); |
173 |
printf("Device %d\n", i); |
174 |
if (Flags & FT_FLAGS_OPENED) |
174 |
if (Flags & FT_FLAGS_OPENED) |
175 |
{ |
175 |
{ |
176 |
printf(" Description Device is used by another process\n"); |
176 |
printf(" Description Device is used by another process\n"); |
177 |
} |
177 |
} |
178 |
else |
178 |
else |
179 |
{ |
179 |
{ |
180 |
printf(" Description \"%s\"\n", Description); |
180 |
printf(" Description \"%s\"\n", Description); |
181 |
printf(" SerialNumber \"%s\"\n", SerialNumber); |
181 |
printf(" SerialNumber \"%s\"\n", SerialNumber); |
182 |
//printf(" Flags 0x%x\n", Flags); |
182 |
//printf(" Flags 0x%x\n", Flags); |
183 |
//printf(" Type 0x%x\n", Type); |
183 |
//printf(" Type 0x%x\n", Type); |
184 |
//printf(" ID 0x%x\n", ID); |
184 |
//printf(" ID 0x%x\n", ID); |
185 |
printf(" Location 0x%x\n", LocId); |
185 |
printf(" Location 0x%x\n", LocId); |
186 |
} |
186 |
} |
187 |
printf("\n"); |
187 |
printf("\n"); |
188 |
} |
188 |
} |
189 |
} |
189 |
} |
190 |
|
190 |
|
191 |
// Select one Device and Open It |
191 |
// Select one Device and Open It |
192 |
unsigned int selectedDeviceIndex = 0; |
192 |
unsigned int selectedDeviceIndex = 0; |
193 |
if (findDeviceBy==0) |
193 |
if (findDeviceBy==0) |
194 |
{ |
194 |
{ |
195 |
// Select by Device Number |
195 |
// Select by Device Number |
196 |
selectedDeviceIndex = atoiEx(findDeviceByStr); |
196 |
selectedDeviceIndex = atoiEx(findDeviceByStr); |
197 |
if (numDevs<=selectedDeviceIndex) |
197 |
if (numDevs<=selectedDeviceIndex) |
198 |
{ |
198 |
{ |
199 |
fprintf(stderr, " There is no Device Number %d\n\n", selectedDeviceIndex); |
199 |
fprintf(stderr, " There is no Device Number %d\n\n", selectedDeviceIndex); |
200 |
return -1; |
200 |
return -1; |
201 |
} |
201 |
} |
202 |
// Open device |
202 |
// Open device |
203 |
ftStatus = FT_Open(selectedDeviceIndex, &ftHandle); |
203 |
ftStatus = FT_Open(selectedDeviceIndex, &ftHandle); |
204 |
} |
204 |
} |
205 |
else |
205 |
else |
206 |
{ |
206 |
{ |
207 |
// Select by Description / Serial Number / Location |
207 |
// Select by Description / Serial Number / Location |
208 |
if (findDeviceBy==FT_OPEN_BY_LOCATION) |
208 |
if (findDeviceBy==FT_OPEN_BY_LOCATION) |
209 |
{ |
209 |
{ |
210 |
// Open device (location is number, not string) |
210 |
// Open device (location is number, not string) |
211 |
int findDeviceByInt = atoiEx(findDeviceByStr); |
211 |
long int findDeviceByInt = atoiEx(findDeviceByStr); |
212 |
ftStatus = FT_OpenEx((void*)findDeviceByInt, findDeviceBy, &ftHandle); |
212 |
ftStatus = FT_OpenEx((void*)findDeviceByInt, findDeviceBy, &ftHandle); |
213 |
} |
213 |
} |
214 |
else |
214 |
else |
215 |
{ |
215 |
{ |
216 |
ftStatus = FT_OpenEx(findDeviceByStr, findDeviceBy, &ftHandle); |
216 |
ftStatus = FT_OpenEx(findDeviceByStr, findDeviceBy, &ftHandle); |
217 |
} |
217 |
} |
218 |
} |
218 |
} |
219 |
|
219 |
|
220 |
// Check Status |
220 |
// Check Status |
221 |
if (ftStatus == FT_OK) |
221 |
if (ftStatus == FT_OK) |
222 |
{ |
222 |
{ |
223 |
ftHandleValid = true; |
223 |
ftHandleValid = true; |
224 |
//printf(" FTDI Device Opened\n"); |
224 |
//printf(" FTDI Device Opened\n"); |
225 |
} |
225 |
} |
226 |
else |
226 |
else |
227 |
{ |
227 |
{ |
228 |
fprintf(stderr, " Can't Open FTDI Device (error code %d)\n\n", ftStatus); |
228 |
fprintf(stderr, " Can't Open FTDI Device (error code %d)\n\n", ftStatus); |
229 |
return -1; |
229 |
return -1; |
230 |
} |
230 |
} |
231 |
|
231 |
|
232 |
// Selected Device |
232 |
// Selected Device |
233 |
ftStatus = FT_GetDeviceInfo(ftHandle, &Type, &ID, SerialNumber, Description, 0); |
233 |
ftStatus = FT_GetDeviceInfo(ftHandle, &Type, &ID, SerialNumber, Description, 0); |
234 |
if (ftStatus == FT_OK) |
234 |
if (ftStatus == FT_OK) |
235 |
{ |
235 |
{ |
236 |
printf("Selected Device\n"); |
236 |
printf("Selected Device\n"); |
237 |
printf(" Description \"%s\"\n", Description); |
237 |
printf(" Description \"%s\"\n", Description); |
238 |
printf(" SerialNumber \"%s\"\n", SerialNumber); |
238 |
printf(" SerialNumber \"%s\"\n", SerialNumber); |
239 |
//printf(" Type 0x%x\n", Type); |
239 |
//printf(" Type 0x%x\n", Type); |
240 |
//printf(" ID 0x%x\n", ID); |
240 |
//printf(" ID 0x%x\n", ID); |
241 |
} |
241 |
} |
242 |
|
242 |
|
243 |
// Get Driver Version |
243 |
// Get Driver Version |
244 |
DWORD dwDriverVer; |
244 |
DWORD dwDriverVer; |
245 |
ftStatus = FT_GetDriverVersion(ftHandle, &dwDriverVer); |
245 |
ftStatus = FT_GetDriverVersion(ftHandle, &dwDriverVer); |
246 |
if (ftStatus == FT_OK) |
246 |
if (ftStatus == FT_OK) |
247 |
{ |
247 |
{ |
248 |
printf(" Device Driver Ver 0x%x\n", dwDriverVer); |
248 |
printf(" Device Driver Ver 0x%x\n", dwDriverVer); |
249 |
} |
249 |
} |
250 |
else |
250 |
else |
251 |
{ |
251 |
{ |
252 |
fprintf(stderr, "FTDI: Error Reading Driver Version\n"); |
252 |
fprintf(stderr, "FTDI: Error Reading Driver Version\n"); |
253 |
} |
253 |
} |
254 |
|
254 |
|
255 |
// Set BitBang Mode |
255 |
// Set BitBang Mode |
256 |
ftStatus = FT_SetBitMode(ftHandle, (UCHAR)(0xFF & IO_OUTPUT_MASK), FT_BITMODE_SYNC_BITBANG); //FT_BITMODE_SYNC_BITBANG / FT_BITMODE_ASYNC_BITBANG |
256 |
ftStatus = FT_SetBitMode(ftHandle, (UCHAR)(0xFF & IO_OUTPUT_MASK), FT_BITMODE_SYNC_BITBANG); //FT_BITMODE_SYNC_BITBANG / FT_BITMODE_ASYNC_BITBANG |
257 |
if (ftStatus == FT_OK) |
257 |
if (ftStatus == FT_OK) |
258 |
{ |
258 |
{ |
259 |
// printf("Set BitBang Mode\n"); |
259 |
// printf("Set BitBang Mode\n"); |
260 |
} |
260 |
} |
261 |
else |
261 |
else |
262 |
{ |
262 |
{ |
263 |
fprintf(stderr, "FTDI: Set BitBang Mode Failed %d\n", ftStatus); |
263 |
fprintf(stderr, "FTDI: Set BitBang Mode Failed %d\n", ftStatus); |
264 |
} |
264 |
} |
265 |
|
265 |
|
266 |
// Set Baud Rate |
266 |
// Set Baud Rate |
267 |
ftStatus = FT_SetBaudRate(ftHandle, BAUD_RATE); |
267 |
ftStatus = FT_SetBaudRate(ftHandle, BAUD_RATE); |
268 |
if (ftStatus == FT_OK) |
268 |
if (ftStatus == FT_OK) |
269 |
{ |
269 |
{ |
270 |
printf(" Baud Rate %d\n", BAUD_RATE); |
270 |
printf(" Baud Rate %d\n", BAUD_RATE); |
271 |
} |
271 |
} |
272 |
else |
272 |
else |
273 |
{ |
273 |
{ |
274 |
fprintf(stderr, "FTDI: Set Baud Rate Failed %d\n", ftStatus); |
274 |
fprintf(stderr, "FTDI: Set Baud Rate Failed %d\n", ftStatus); |
275 |
} |
275 |
} |
276 |
|
276 |
|
277 |
ftStatus = FT_Purge(ftHandle, FT_PURGE_RX | FT_PURGE_TX); // Purge both Rx and Tx buffers |
277 |
ftStatus = FT_Purge(ftHandle, FT_PURGE_RX | FT_PURGE_TX); // Purge both Rx and Tx buffers |
278 |
if (ftStatus == FT_OK) |
278 |
if (ftStatus == FT_OK) |
279 |
{ |
279 |
{ |
280 |
// printf("Purge \n"); |
280 |
// printf("Purge \n"); |
281 |
} |
281 |
} |
282 |
else |
282 |
else |
283 |
{ |
283 |
{ |
284 |
fprintf(stderr, "FTDI: FT_Purge failed %d\n", ftStatus); |
284 |
fprintf(stderr, "FTDI: FT_Purge failed %d\n", ftStatus); |
285 |
} |
285 |
} |
286 |
|
286 |
|
287 |
ftStatus = FT_SetLatencyTimer(ftHandle, USB_LATENCY); // Latency in ms |
287 |
ftStatus = FT_SetLatencyTimer(ftHandle, USB_LATENCY); // Latency in ms |
288 |
if (ftStatus == FT_OK) |
288 |
if (ftStatus == FT_OK) |
289 |
{ |
289 |
{ |
290 |
printf(" USB Latency %d\n", USB_LATENCY); |
290 |
printf(" USB Latency %d\n", USB_LATENCY); |
291 |
} |
291 |
} |
292 |
else |
292 |
else |
293 |
{ |
293 |
{ |
294 |
fprintf(stderr, "FTDI: Set USB Latency Timer Failed %d\n", ftStatus); |
294 |
fprintf(stderr, "FTDI: Set USB Latency Timer Failed %d\n", ftStatus); |
295 |
} |
295 |
} |
296 |
|
296 |
|
297 |
// Fix (without this delay the next FT_Read hang for ever) |
297 |
// Fix (without this delay the next FT_Read hang for ever) |
298 |
// My Linux i5 notebook requires at least 2500us |
298 |
// My Linux i5 notebook requires at least 2500us |
299 |
#ifdef WIN32 |
299 |
#ifdef WIN32 |
300 |
Sleep(10); //ms |
300 |
Sleep(10); //ms |
301 |
#else |
301 |
#else |
302 |
usleep(10000); //us |
302 |
usleep(10000); //us |
303 |
#endif |
303 |
#endif |
304 |
|
304 |
|
305 |
printf("\n"); |
305 |
printf("\n"); |
306 |
return 0; |
306 |
return 0; |
307 |
} |
307 |
} |
308 |
|
308 |
|
309 |
|
309 |
|
310 |
// Enable or Disable Activity LED |
310 |
// Enable or Disable Activity LED |
311 |
void jtagSetLED(bool LedEnable) |
311 |
void jtagSetLED(bool LedEnable) |
312 |
{ |
312 |
{ |
313 |
// DBUS Connected LED (BitBang Mode) |
313 |
// DBUS Connected LED (BitBang Mode) |
314 |
LedMask = LedEnable ? (0xFF & PORT_LED) : 0; // Set mask for jtagScan function |
314 |
LedMask = LedEnable ? (0xFF & PORT_LED) : 0; // Set mask for jtagScan function |
315 |
if (PORT_LED & 0xFF) |
315 |
if (PORT_LED & 0xFF) |
316 |
{ |
316 |
{ |
317 |
// Set / Reset LED Pin |
317 |
// Set / Reset LED Pin |
318 |
DWORD BytesWritten; |
318 |
DWORD BytesWritten; |
319 |
DWORD BytesReceived; |
319 |
DWORD BytesReceived; |
320 |
unsigned char DataOut = LedMask | (PinStatus & ~PORT_LED); // Preserve PinStatus |
320 |
unsigned char DataOut = LedMask | (PinStatus & ~PORT_LED); // Preserve PinStatus |
321 |
unsigned char Dummy; |
321 |
unsigned char Dummy; |
322 |
FT_Write(ftHandle, &DataOut, 1, &BytesWritten ); // Send 1 byte |
322 |
FT_Write(ftHandle, &DataOut, 1, &BytesWritten ); // Send 1 byte |
323 |
FT_Read (ftHandle, &Dummy, 1, &BytesReceived); // Read 1 byte |
323 |
FT_Read (ftHandle, &Dummy, 1, &BytesReceived); // Read 1 byte |
324 |
} |
324 |
} |
325 |
|
325 |
|
326 |
// CBUS Connected LED (BitBang Mode) 1 and 0 state of the port |
326 |
// CBUS Connected LED (BitBang Mode) 1 and 0 state of the port |
327 |
const unsigned char On = ( ((PORT_LED & 0x0F00) >> 4) | ((PORT_LED & 0x0F00) >> 8) ); |
327 |
const unsigned char On = ( ((PORT_LED & 0x0F00) >> 4) | ((PORT_LED & 0x0F00) >> 8) ); |
328 |
const unsigned char Off = ( ((PORT_LED & 0x0F00) >> 4) ); |
328 |
const unsigned char Off = ( ((PORT_LED & 0x0F00) >> 4) ); |
329 |
|
329 |
|
330 |
if (On) |
330 |
if (On) |
331 |
{ |
331 |
{ |
332 |
// Set / Reset LED Pin |
332 |
// Set / Reset LED Pin |
333 |
FT_SetBitMode(ftHandle, LedEnable ? On : Off, FT_BITMODE_CBUS_BITBANG); |
333 |
FT_SetBitMode(ftHandle, LedEnable ? On : Off, FT_BITMODE_CBUS_BITBANG); |
334 |
|
334 |
|
335 |
// Return to used Mode |
335 |
// Return to used Mode |
336 |
FT_SetBitMode(ftHandle, (UCHAR)(0xFF & IO_OUTPUT_MASK), FT_BITMODE_SYNC_BITBANG); //FT_BITMODE_SYNC_BITBANG / FT_BITMODE_ASYNC_BITBANG |
336 |
FT_SetBitMode(ftHandle, (UCHAR)(0xFF & IO_OUTPUT_MASK), FT_BITMODE_SYNC_BITBANG); //FT_BITMODE_SYNC_BITBANG / FT_BITMODE_ASYNC_BITBANG |
337 |
} |
337 |
} |
338 |
} |
338 |
} |
339 |
|
339 |
|
340 |
|
340 |
|
341 |
// Set port to Idle state |
341 |
// Set port to Idle state |
342 |
void jtagSetIdle() |
342 |
void jtagSetIdle() |
343 |
{ |
343 |
{ |
344 |
char b = 0; // Idle State for JTAG pins |
344 |
char b = 0; // Idle State for JTAG pins |
345 |
DWORD BytesWritten; |
345 |
DWORD BytesWritten; |
346 |
DWORD BytesReceived; |
346 |
DWORD BytesReceived; |
347 |
|
347 |
|
348 |
// Write (idle state of pins) |
348 |
// Write (idle state of pins) |
349 |
FT_Write(ftHandle, &b, 1, &BytesWritten); |
349 |
FT_Write(ftHandle, &b, 1, &BytesWritten); |
350 |
// Read (not to left data in input fifo) |
350 |
// Read (not to left data in input fifo) |
351 |
FT_Read(ftHandle, &b, 1, &BytesReceived); |
351 |
FT_Read(ftHandle, &b, 1, &BytesReceived); |
352 |
} |
352 |
} |
353 |
|
353 |
|
354 |
|
354 |
|
355 |
// Close FTDI connection |
355 |
// Close FTDI connection |
356 |
int jtagClosePort() |
356 |
int jtagClosePort() |
357 |
{ |
357 |
{ |
358 |
if (ftHandleValid) |
358 |
if (ftHandleValid) |
359 |
{ |
359 |
{ |
360 |
jtagSetLED(false); |
360 |
jtagSetLED(false); |
361 |
// Switch Off the Outputs |
361 |
// Switch Off the Outputs |
362 |
FT_Purge(ftHandle, FT_PURGE_RX | FT_PURGE_TX); // Purge both Rx and Tx buffers |
362 |
FT_Purge(ftHandle, FT_PURGE_RX | FT_PURGE_TX); // Purge both Rx and Tx buffers |
363 |
FT_SetBitMode(ftHandle, 0, FT_BITMODE_SYNC_BITBANG); |
363 |
FT_SetBitMode(ftHandle, 0, FT_BITMODE_SYNC_BITBANG); |
364 |
// Close FTDI Lib |
364 |
// Close FTDI Lib |
365 |
FT_Close(ftHandle); |
365 |
FT_Close(ftHandle); |
366 |
ftHandleValid = false; |
366 |
ftHandleValid = false; |
367 |
} |
367 |
} |
368 |
return 0; |
368 |
return 0; |
369 |
} |
369 |
} |
370 |
|
370 |
|
371 |
|
371 |
|
372 |
// Send data to JTAG port and bring returned data |
372 |
// Send data to JTAG port and bring returned data |
373 |
int jtagScan(const unsigned char *TMS, const unsigned char *TDI, unsigned char *TDO, unsigned int bits) |
373 |
int jtagScan(const unsigned char *TMS, const unsigned char *TDI, unsigned char *TDO, unsigned int bits) |
374 |
{ |
374 |
{ |
375 |
FT_STATUS ftStatus; |
375 |
FT_STATUS ftStatus; |
376 |
DWORD BytesWritten; |
376 |
DWORD BytesWritten; |
377 |
DWORD BytesReceived; |
377 |
DWORD BytesReceived; |
378 |
unsigned int r, t; |
378 |
unsigned int r, t; |
379 |
|
379 |
|
380 |
// Decompose TDI and TMS byte array to raw bitstream |
380 |
// Decompose TDI and TMS byte array to raw bitstream |
381 |
//(1 TDI bit + 1 TMS bit --> 1 byte + 1 byte with TCK) |
381 |
//(1 TDI bit + 1 TMS bit --> 1 byte + 1 byte with TCK) |
382 |
unsigned char buffer[16384]; |
382 |
unsigned char buffer[16384]; |
383 |
if (bits > sizeof(buffer)/2) |
383 |
if (bits > sizeof(buffer)/2) |
384 |
{ |
384 |
{ |
385 |
fprintf(stderr, "\n FTDI: Out of Buffer Space for %d bits\n", bits); |
385 |
fprintf(stderr, "\n FTDI: Out of Buffer Space for %d bits\n", bits); |
386 |
return -1; |
386 |
return -1; |
387 |
} |
387 |
} |
388 |
|
388 |
|
389 |
// Switch LED On |
389 |
// Switch LED On |
390 |
jtagSetLED(true); |
390 |
jtagSetLED(true); |
391 |
|
391 |
|
392 |
// Prepare transmit data to buffer |
392 |
// Prepare transmit data to buffer |
393 |
for (unsigned int i = 0; i < bits; ++i) |
393 |
for (unsigned int i = 0; i < bits; ++i) |
394 |
{ |
394 |
{ |
395 |
unsigned char v = 0 | LedMask; // LED On / Off (on DBUS) |
395 |
unsigned char v = 0 | LedMask; // LED On / Off (on DBUS) |
396 |
if (TMS[i/8] & (1<<(i&7))) |
396 |
if (TMS[i/8] & (1<<(i&7))) |
397 |
{ |
397 |
{ |
398 |
v |= PORT_TMS; |
398 |
v |= PORT_TMS; |
399 |
// printf("T"); |
399 |
// printf("T"); |
400 |
} |
400 |
} |
401 |
else |
401 |
else |
402 |
{ |
402 |
{ |
403 |
// printf("t"); |
403 |
// printf("t"); |
404 |
} |
404 |
} |
405 |
if (TDI[i/8] & (1<<(i&7))) |
405 |
if (TDI[i/8] & (1<<(i&7))) |
406 |
{ |
406 |
{ |
407 |
v |= PORT_TDI; |
407 |
v |= PORT_TDI; |
408 |
// printf("|"); |
408 |
// printf("|"); |
409 |
} |
409 |
} |
410 |
else |
410 |
else |
411 |
{ |
411 |
{ |
412 |
// printf("."); |
412 |
// printf("."); |
413 |
} |
413 |
} |
414 |
buffer[i * 2 + 0] = v; |
414 |
buffer[i * 2 + 0] = v; |
415 |
buffer[i * 2 + 1] = v | PORT_TCK; |
415 |
buffer[i * 2 + 1] = v | PORT_TCK; |
416 |
} |
416 |
} |
417 |
PinStatus = buffer[bits*2-1]; |
417 |
PinStatus = buffer[bits*2-1]; |
418 |
// printf("\n"); |
418 |
// printf("\n"); |
419 |
|
419 |
|
420 |
// Send data to FTDI |
420 |
// Send data to FTDI |
421 |
r = 0; |
421 |
r = 0; |
422 |
while (r < bits * 2) |
422 |
while (r < bits * 2) |
423 |
{ |
423 |
{ |
424 |
t = bits * 2 - r; |
424 |
t = bits * 2 - r; |
425 |
if (t > FTDI_MAX_WRITESIZE) |
425 |
if (t > FTDI_MAX_WRITESIZE) |
426 |
{ |
426 |
{ |
427 |
t = FTDI_MAX_WRITESIZE; |
427 |
t = FTDI_MAX_WRITESIZE; |
428 |
} |
428 |
} |
429 |
|
429 |
|
430 |
// printf("writing %d bytes to FTDI\n", t); |
430 |
// printf("writing %d bytes to FTDI\n", t); |
431 |
ftStatus = FT_Write(ftHandle, buffer+r, t, &BytesWritten); |
431 |
ftStatus = FT_Write(ftHandle, buffer+r, t, &BytesWritten); |
432 |
if (ftStatus != FT_OK) |
432 |
if (ftStatus != FT_OK) |
433 |
{ |
433 |
{ |
434 |
fprintf(stderr, "\n FTDI: Error Writing\n"); |
434 |
fprintf(stderr, "\n FTDI: Error Writing\n"); |
435 |
return -2; |
435 |
return -2; |
436 |
} |
436 |
} |
437 |
|
437 |
|
438 |
unsigned int i = 0; |
438 |
unsigned int i = 0; |
439 |
|
439 |
|
440 |
while (i < t) |
440 |
while (i < t) |
441 |
{ |
441 |
{ |
442 |
FT_SetTimeouts(ftHandle, 5000, 0); // timeout 5 sec |
442 |
FT_SetTimeouts(ftHandle, 5000, 0); // timeout 5 sec |
443 |
ftStatus = FT_Read(ftHandle, buffer+r+i, t-i, &BytesReceived); |
443 |
ftStatus = FT_Read(ftHandle, buffer+r+i, t-i, &BytesReceived); |
444 |
if (ftStatus == FT_OK) |
444 |
if (ftStatus == FT_OK) |
445 |
{ |
445 |
{ |
446 |
if (BytesReceived == t-i) |
446 |
if (BytesReceived == t-i) |
447 |
{ |
447 |
{ |
448 |
// FT_Read OK |
448 |
// FT_Read OK |
449 |
// printf("Read from FTDI %d bytes", BytesReceived); |
449 |
// printf("Read from FTDI %d bytes", BytesReceived); |
450 |
} |
450 |
} |
451 |
else |
451 |
else |
452 |
{ |
452 |
{ |
453 |
// FT_Read Timeout |
453 |
// FT_Read Timeout |
454 |
fprintf(stderr, "\n FTDI: Read Timeout\n"); |
454 |
fprintf(stderr, "\n FTDI: Read Timeout\n"); |
455 |
return -2; |
455 |
return -2; |
456 |
} |
456 |
} |
457 |
} |
457 |
} |
458 |
else |
458 |
else |
459 |
{ |
459 |
{ |
460 |
fprintf(stderr, "\n FTDI: Error Reading\n");// Error |
460 |
fprintf(stderr, "\n FTDI: Error Reading\n");// Error |
461 |
return -2; |
461 |
return -2; |
462 |
} |
462 |
} |
463 |
|
463 |
|
464 |
i += BytesReceived; |
464 |
i += BytesReceived; |
465 |
} |
465 |
} |
466 |
|
466 |
|
467 |
r += t; |
467 |
r += t; |
468 |
} |
468 |
} |
469 |
|
469 |
|
470 |
// Pack TDO bitstream from receive buffer to byte array |
470 |
// Pack TDO bitstream from receive buffer to byte array |
471 |
memset(TDO, 0, (bits + 7) / 8); |
471 |
memset(TDO, 0, (bits + 7) / 8); |
472 |
|
472 |
|
473 |
for (unsigned int i = 0; i < bits; ++i) |
473 |
for (unsigned int i = 0; i < bits; ++i) |
474 |
{ |
474 |
{ |
475 |
if (buffer[i * 2 + 1] & PORT_TDO) |
475 |
if (buffer[i * 2 + 1] & PORT_TDO) |
476 |
{ |
476 |
{ |
477 |
TDO[i/8] |= 1 << (i&7); |
477 |
TDO[i/8] |= 1 << (i&7); |
478 |
// printf("H"); |
478 |
// printf("H"); |
479 |
} |
479 |
} |
480 |
else |
480 |
else |
481 |
{ |
481 |
{ |
482 |
// printf("L"); |
482 |
// printf("L"); |
483 |
} |
483 |
} |
484 |
} |
484 |
} |
485 |
// printf("\n"); |
485 |
// printf("\n"); |
486 |
// printf(" Bits %d ", bit_counter); |
486 |
// printf(" Bits %d ", bit_counter); |
487 |
|
487 |
|
488 |
// Switch LED Off |
488 |
// Switch LED Off |
489 |
jtagSetLED(false); |
489 |
jtagSetLED(false); |
490 |
|
490 |
|
491 |
return 0; |
491 |
return 0; |
492 |
} |
492 |
} |
493 |
|
493 |
|
494 |
// Check if Cable is still connected and accesible |
494 |
// Check if Cable is still connected and accesible |
495 |
// True is o.k. |
495 |
// True is o.k. |
496 |
bool CheckCable() |
496 |
bool CheckCable() |
497 |
{ |
497 |
{ |
498 |
FT_STATUS ftStatus; |
498 |
FT_STATUS ftStatus; |
499 |
|
499 |
|
500 |
DWORD lpdwAmountInRxQueue, lpdwAmountInTxQueue, lpdwEventStatus; |
500 |
DWORD lpdwAmountInRxQueue, lpdwAmountInTxQueue, lpdwEventStatus; |
501 |
|
501 |
|
502 |
ftStatus = FT_GetStatus(ftHandle, &lpdwAmountInRxQueue, &lpdwAmountInTxQueue, &lpdwEventStatus); |
502 |
ftStatus = FT_GetStatus(ftHandle, &lpdwAmountInRxQueue, &lpdwAmountInTxQueue, &lpdwEventStatus); |
503 |
return (ftStatus==FT_OK); |
503 |
return (ftStatus==FT_OK); |
504 |
} |
504 |
} |