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