This source file includes following definitions.
- kbic_read_regr
- kbic_write_regr
- k951_connect
- k951_disconnect
- k971_connect
- k971_disconnect
- kbic_read_block
- kbic_write_block
- kbic_log_adapter
- k951_log_adapter
- k971_log_adapter
- kbic_init
- kbic_exit
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21 #define KBIC_VERSION "1.01"
22
23 #include <linux/module.h>
24 #include <linux/init.h>
25 #include <linux/delay.h>
26 #include <linux/kernel.h>
27 #include <linux/types.h>
28 #include <linux/wait.h>
29 #include <asm/io.h>
30
31 #include "paride.h"
32
33 #define r12w() (delay_p,inw(pi->port+1)&0xffff)
34
35 #define j44(a,b) ((((a>>4)&0x0f)|(b&0xf0))^0x88)
36 #define j53(w) (((w>>3)&0x1f)|((w>>4)&0xe0))
37
38
39
40
41
42
43 static int cont_map[2] = { 0x80, 0x40 };
44
45 static int kbic_read_regr( PIA *pi, int cont, int regr )
46
47 { int a, b, s;
48
49 s = cont_map[cont];
50
51 switch (pi->mode) {
52
53 case 0: w0(regr|0x18|s); w2(4); w2(6); w2(4); w2(1); w0(8);
54 a = r1(); w0(0x28); b = r1(); w2(4);
55 return j44(a,b);
56
57 case 1: w0(regr|0x38|s); w2(4); w2(6); w2(4); w2(5); w0(8);
58 a = r12w(); w2(4);
59 return j53(a);
60
61 case 2: w0(regr|0x08|s); w2(4); w2(6); w2(4); w2(0xa5); w2(0xa1);
62 a = r0(); w2(4);
63 return a;
64
65 case 3:
66 case 4:
67 case 5: w0(0x20|s); w2(4); w2(6); w2(4); w3(regr);
68 a = r4(); b = r4(); w2(4); w2(0); w2(4);
69 return a;
70
71 }
72 return -1;
73 }
74
75 static void kbic_write_regr( PIA *pi, int cont, int regr, int val)
76
77 { int s;
78
79 s = cont_map[cont];
80
81 switch (pi->mode) {
82
83 case 0:
84 case 1:
85 case 2: w0(regr|0x10|s); w2(4); w2(6); w2(4);
86 w0(val); w2(5); w2(4);
87 break;
88
89 case 3:
90 case 4:
91 case 5: w0(0x20|s); w2(4); w2(6); w2(4); w3(regr);
92 w4(val); w4(val);
93 w2(4); w2(0); w2(4);
94 break;
95
96 }
97 }
98
99 static void k951_connect ( PIA *pi )
100
101 { pi->saved_r0 = r0();
102 pi->saved_r2 = r2();
103 w2(4);
104 }
105
106 static void k951_disconnect ( PIA *pi )
107
108 { w0(pi->saved_r0);
109 w2(pi->saved_r2);
110 }
111
112 #define CCP(x) w2(0xc4);w0(0xaa);w0(0x55);w0(0);w0(0xff);w0(0x87);\
113 w0(0x78);w0(x);w2(0xc5);w2(0xc4);w0(0xff);
114
115 static void k971_connect ( PIA *pi )
116
117 { pi->saved_r0 = r0();
118 pi->saved_r2 = r2();
119 CCP(0x20);
120 w2(4);
121 }
122
123 static void k971_disconnect ( PIA *pi )
124
125 { CCP(0x30);
126 w0(pi->saved_r0);
127 w2(pi->saved_r2);
128 }
129
130
131
132
133
134 static void kbic_read_block( PIA *pi, char * buf, int count )
135
136 { int k, a, b;
137
138 switch (pi->mode) {
139
140 case 0: w0(0x98); w2(4); w2(6); w2(4);
141 for (k=0;k<count/2;k++) {
142 w2(1); w0(8); a = r1();
143 w0(0x28); b = r1();
144 buf[2*k] = j44(a,b);
145 w2(5); b = r1();
146 w0(8); a = r1();
147 buf[2*k+1] = j44(a,b);
148 w2(4);
149 }
150 break;
151
152 case 1: w0(0xb8); w2(4); w2(6); w2(4);
153 for (k=0;k<count/4;k++) {
154 w0(0xb8);
155 w2(4); w2(5);
156 w0(8); buf[4*k] = j53(r12w());
157 w0(0xb8); buf[4*k+1] = j53(r12w());
158 w2(4); w2(5);
159 buf[4*k+3] = j53(r12w());
160 w0(8); buf[4*k+2] = j53(r12w());
161 }
162 w2(4);
163 break;
164
165 case 2: w0(0x88); w2(4); w2(6); w2(4);
166 for (k=0;k<count/2;k++) {
167 w2(0xa0); w2(0xa1); buf[2*k] = r0();
168 w2(0xa5); buf[2*k+1] = r0();
169 }
170 w2(4);
171 break;
172
173 case 3: w0(0xa0); w2(4); w2(6); w2(4); w3(0);
174 for (k=0;k<count;k++) buf[k] = r4();
175 w2(4); w2(0); w2(4);
176 break;
177
178 case 4: w0(0xa0); w2(4); w2(6); w2(4); w3(0);
179 for (k=0;k<count/2;k++) ((u16 *)buf)[k] = r4w();
180 w2(4); w2(0); w2(4);
181 break;
182
183 case 5: w0(0xa0); w2(4); w2(6); w2(4); w3(0);
184 for (k=0;k<count/4;k++) ((u32 *)buf)[k] = r4l();
185 w2(4); w2(0); w2(4);
186 break;
187
188
189 }
190 }
191
192 static void kbic_write_block( PIA *pi, char * buf, int count )
193
194 { int k;
195
196 switch (pi->mode) {
197
198 case 0:
199 case 1:
200 case 2: w0(0x90); w2(4); w2(6); w2(4);
201 for(k=0;k<count/2;k++) {
202 w0(buf[2*k+1]); w2(0); w2(4);
203 w0(buf[2*k]); w2(5); w2(4);
204 }
205 break;
206
207 case 3: w0(0xa0); w2(4); w2(6); w2(4); w3(0);
208 for(k=0;k<count/2;k++) {
209 w4(buf[2*k+1]);
210 w4(buf[2*k]);
211 }
212 w2(4); w2(0); w2(4);
213 break;
214
215 case 4: w0(0xa0); w2(4); w2(6); w2(4); w3(0);
216 for(k=0;k<count/2;k++) w4w(pi_swab16(buf,k));
217 w2(4); w2(0); w2(4);
218 break;
219
220 case 5: w0(0xa0); w2(4); w2(6); w2(4); w3(0);
221 for(k=0;k<count/4;k++) w4l(pi_swab32(buf,k));
222 w2(4); w2(0); w2(4);
223 break;
224
225 }
226
227 }
228
229 static void kbic_log_adapter( PIA *pi, char * scratch,
230 int verbose, char * chip )
231
232 { char *mode_string[6] = {"4-bit","5/3","8-bit",
233 "EPP-8","EPP_16","EPP-32"};
234
235 printk("%s: kbic %s, KingByte %s at 0x%x, ",
236 pi->device,KBIC_VERSION,chip,pi->port);
237 printk("mode %d (%s), delay %d\n",pi->mode,
238 mode_string[pi->mode],pi->delay);
239
240 }
241
242 static void k951_log_adapter( PIA *pi, char * scratch, int verbose )
243
244 { kbic_log_adapter(pi,scratch,verbose,"KBIC-951A");
245 }
246
247 static void k971_log_adapter( PIA *pi, char * scratch, int verbose )
248
249 { kbic_log_adapter(pi,scratch,verbose,"KBIC-971A");
250 }
251
252 static struct pi_protocol k951 = {
253 .owner = THIS_MODULE,
254 .name = "k951",
255 .max_mode = 6,
256 .epp_first = 3,
257 .default_delay = 1,
258 .max_units = 1,
259 .write_regr = kbic_write_regr,
260 .read_regr = kbic_read_regr,
261 .write_block = kbic_write_block,
262 .read_block = kbic_read_block,
263 .connect = k951_connect,
264 .disconnect = k951_disconnect,
265 .log_adapter = k951_log_adapter,
266 };
267
268 static struct pi_protocol k971 = {
269 .owner = THIS_MODULE,
270 .name = "k971",
271 .max_mode = 6,
272 .epp_first = 3,
273 .default_delay = 1,
274 .max_units = 1,
275 .write_regr = kbic_write_regr,
276 .read_regr = kbic_read_regr,
277 .write_block = kbic_write_block,
278 .read_block = kbic_read_block,
279 .connect = k971_connect,
280 .disconnect = k971_disconnect,
281 .log_adapter = k971_log_adapter,
282 };
283
284 static int __init kbic_init(void)
285 {
286 int rv;
287
288 rv = paride_register(&k951);
289 if (rv < 0)
290 return rv;
291 rv = paride_register(&k971);
292 if (rv < 0)
293 paride_unregister(&k951);
294 return rv;
295 }
296
297 static void __exit kbic_exit(void)
298 {
299 paride_unregister(&k951);
300 paride_unregister(&k971);
301 }
302
303 MODULE_LICENSE("GPL");
304 module_init(kbic_init)
305 module_exit(kbic_exit)