]>
Commit | Line | Data |
---|---|---|
1 | #ifdef WIN32 | |
2 | #include "libnexys.win32.c" | |
3 | #else | |
4 | #define LIBNEXYS_INTERNAL | |
5 | #ifndef PARPORT | |
6 | # define PARPORT | |
7 | #endif | |
8 | #include "libnexys.h" | |
9 | #include <stdio.h> | |
10 | #include <fcntl.h> | |
11 | #include <linux/ioctl.h> | |
12 | #include <linux/ppdev.h> | |
13 | #include <string.h> | |
14 | ||
15 | #define TDI 0 | |
16 | #define TCK 1 | |
17 | #define TMS 2 | |
18 | #define TDO 4 | |
19 | ||
20 | ||
21 | nexys2_t nexys2_init(void) { | |
22 | int pfd = open("/dev/parport0", O_RDWR); | |
23 | if (pfd < 0) | |
24 | { | |
25 | perror("open /dev/parport0"); | |
26 | return -1; | |
27 | } | |
28 | ||
29 | if ((ioctl(pfd, PPEXCL) < 0) || (ioctl(pfd, PPCLAIM) < 0)) | |
30 | { | |
31 | perror("lock /dev/parport0"); | |
32 | return -1; | |
33 | } | |
34 | ||
35 | return pfd; | |
36 | } | |
37 | ||
38 | int nexys2_jtag_enable(int pfd) | |
39 | { | |
40 | return 0; | |
41 | } | |
42 | ||
43 | int nexys2_jtag_disable(int pfd) | |
44 | { | |
45 | return 0; | |
46 | } | |
47 | ||
48 | int nexys2_jtag_setbits(int pfd, int tms, int tdi, int tck) | |
49 | { | |
50 | unsigned char data; | |
51 | int i; | |
52 | ||
53 | data = ((!!tms) << TMS) | ((!!tdi) << TDI) | ((!!tck) << TCK); | |
54 | ||
55 | if (ioctl(pfd, PPWDATA, &data) < 0) | |
56 | { | |
57 | perror("nexys2_jtag_setbits: ioctl"); | |
58 | return -1; | |
59 | } | |
60 | ||
61 | return 0; | |
62 | } | |
63 | ||
64 | int _gettdo(int pfd) | |
65 | { | |
66 | unsigned char data; | |
67 | ||
68 | if (ioctl(pfd, PPRSTATUS, &data) < 0) | |
69 | { | |
70 | perror("_gettdi: PPRSTATUS"); | |
71 | return -1; | |
72 | } | |
73 | ||
74 | data ^= 0x80; | |
75 | data >>= TDO; | |
76 | data &= 1; | |
77 | ||
78 | return data; | |
79 | } | |
80 | ||
81 | int nexys2_jtag_puttdi(int pfd, int tms, int nbits, unsigned char *bits, unsigned char *obits) | |
82 | { | |
83 | int i; | |
84 | ||
85 | if (obits) | |
86 | memset(obits, 0, (nbits / 8) + ((nbits % 8) != 0)); | |
87 | ||
88 | for (i = 0; i < nbits; i++) | |
89 | { | |
90 | int bit; | |
91 | ||
92 | bit = bits[i / 8] & (1 << (i % 8)); | |
93 | nexys2_jtag_setbits(pfd, tms, bit, 1); | |
94 | nexys2_jtag_setbits(pfd, tms, bit, 0); | |
95 | if (obits) | |
96 | obits[i/8] |= _gettdo(pfd) << (i % 8); | |
97 | } | |
98 | return 0; | |
99 | } | |
100 | ||
101 | int nexys2_jtag_puttmstdi(int pfd, int nbits, unsigned char *bits, unsigned char *obits) | |
102 | { | |
103 | int i; | |
104 | ||
105 | if (obits) | |
106 | memset(obits, 0, (nbits / 8) + ((nbits % 8) != 0)); | |
107 | ||
108 | for (i = 0; i < nbits; i++) | |
109 | { | |
110 | int tdi, tms; | |
111 | ||
112 | tdi = bits[i / 4] & (1 << ((i % 4) * 2)); | |
113 | tms = bits[i / 4] & (2 << ((i % 4) * 2)); | |
114 | nexys2_jtag_setbits(pfd, tms, tdi, 0); | |
115 | nexys2_jtag_setbits(pfd, tms, tdi, 1); | |
116 | nexys2_jtag_setbits(pfd, tms, tdi, 0); | |
117 | if (obits) | |
118 | obits[i/8] |= _gettdo(pfd) << (i % 8); | |
119 | } | |
120 | return 0; | |
121 | } | |
122 | ||
123 | int nexys2_jtag_gettdo(int pfd, int tdi, int tms, int nbits, unsigned char *obits) | |
124 | { | |
125 | int i; | |
126 | ||
127 | if (obits) | |
128 | memset(obits, 0, (nbits / 8) + ((nbits % 8) != 0)); | |
129 | ||
130 | for (i = 0; i < nbits; i++) | |
131 | { | |
132 | nexys2_jtag_setbits(pfd, tms, tdi, 0); | |
133 | nexys2_jtag_setbits(pfd, tms, tdi, 1); | |
134 | nexys2_jtag_setbits(pfd, tms, tdi, 0); | |
135 | if (obits) | |
136 | obits[i/8] |= _gettdo(pfd) << (i % 8); | |
137 | } | |
138 | return 0; | |
139 | } | |
140 | ||
141 | #endif | |
142 | ||
143 | #ifdef TEST_DRIVER | |
144 | ||
145 | void poke_idcode(nexys2_t nexys) | |
146 | { | |
147 | unsigned char seq1[] = { 0xaa, 0x22}; | |
148 | unsigned char seq2[] = { 0xaa, 0x02}; | |
149 | unsigned int idcode = 0; | |
150 | unsigned int woop = 0x12345678; | |
151 | ||
152 | // while(1) | |
153 | { | |
154 | while (nexys2_jtag_enable(nexys) < 0) | |
155 | ; | |
156 | if (nexys2_jtag_puttmstdi(nexys, 8, seq1, NULL) < 0) | |
157 | return; | |
158 | do | |
159 | { | |
160 | if (nexys2_jtag_gettdo(nexys, 0, 0, 32, &idcode) < 0) | |
161 | return; | |
162 | printf("IDCODE: %08x\n", idcode); | |
163 | } while(idcode && (idcode != 0xFFFFFFFF)); | |
164 | if (nexys2_jtag_puttmstdi(nexys, 8, seq2, NULL) < 0) | |
165 | return; | |
166 | if (nexys2_jtag_disable(nexys) < 0) | |
167 | return; | |
168 | } | |
169 | } | |
170 | ||
171 | void main() | |
172 | { | |
173 | nexys2_t nexys; | |
174 | nexys = nexys2_init(); | |
175 | if (!nexys) | |
176 | return; | |
177 | poke_idcode(nexys); | |
178 | } | |
179 | ||
180 | #endif | |
181 |