1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17#define COMM_VERSION "1.01"
18
19#include <linux/module.h>
20#include <linux/init.h>
21#include <linux/delay.h>
22#include <linux/kernel.h>
23#include <linux/types.h>
24#include <linux/wait.h>
25#include <asm/io.h>
26
27#include "paride.h"
28
29
30
31
32
33
34#define j44(a,b) (((a>>3)&0x0f)|((b<<1)&0xf0))
35
36#define P1 w2(5);w2(0xd);w2(0xd);w2(5);w2(4);
37#define P2 w2(5);w2(7);w2(7);w2(5);w2(4);
38
39
40
41
42
43static int cont_map[2] = { 0x08, 0x10 };
44
45static int comm_read_regr( PIA *pi, int cont, int regr )
46
47{ int l, h, r;
48
49 r = regr + cont_map[cont];
50
51 switch (pi->mode) {
52
53 case 0: w0(r); P1; w0(0);
54 w2(6); l = r1(); w0(0x80); h = r1(); w2(4);
55 return j44(l,h);
56
57 case 1: w0(r+0x20); P1;
58 w0(0); w2(0x26); h = r0(); w2(4);
59 return h;
60
61 case 2:
62 case 3:
63 case 4: w3(r+0x20); (void)r1();
64 w2(0x24); h = r4(); w2(4);
65 return h;
66
67 }
68 return -1;
69}
70
71static void comm_write_regr( PIA *pi, int cont, int regr, int val )
72
73{ int r;
74
75 r = regr + cont_map[cont];
76
77 switch (pi->mode) {
78
79 case 0:
80 case 1: w0(r); P1; w0(val); P2;
81 break;
82
83 case 2:
84 case 3:
85 case 4: w3(r); (void)r1(); w4(val);
86 break;
87 }
88}
89
90static void comm_connect ( PIA *pi )
91
92{ pi->saved_r0 = r0();
93 pi->saved_r2 = r2();
94 w2(4); w0(0xff); w2(6);
95 w2(4); w0(0xaa); w2(6);
96 w2(4); w0(0x00); w2(6);
97 w2(4); w0(0x87); w2(6);
98 w2(4); w0(0xe0); w2(0xc); w2(0xc); w2(4);
99}
100
101static void comm_disconnect ( PIA *pi )
102
103{ w2(0); w2(0); w2(0); w2(4);
104 w0(pi->saved_r0);
105 w2(pi->saved_r2);
106}
107
108static void comm_read_block( PIA *pi, char * buf, int count )
109
110{ int i, l, h;
111
112 switch (pi->mode) {
113
114 case 0: w0(0x48); P1;
115 for(i=0;i<count;i++) {
116 w0(0); w2(6); l = r1();
117 w0(0x80); h = r1(); w2(4);
118 buf[i] = j44(l,h);
119 }
120 break;
121
122 case 1: w0(0x68); P1; w0(0);
123 for(i=0;i<count;i++) {
124 w2(0x26); buf[i] = r0(); w2(0x24);
125 }
126 w2(4);
127 break;
128
129 case 2: w3(0x68); (void)r1(); w2(0x24);
130 for (i=0;i<count;i++) buf[i] = r4();
131 w2(4);
132 break;
133
134 case 3: w3(0x68); (void)r1(); w2(0x24);
135 for (i=0;i<count/2;i++) ((u16 *)buf)[i] = r4w();
136 w2(4);
137 break;
138
139 case 4: w3(0x68); (void)r1(); w2(0x24);
140 for (i=0;i<count/4;i++) ((u32 *)buf)[i] = r4l();
141 w2(4);
142 break;
143
144 }
145}
146
147
148
149static void comm_write_block( PIA *pi, char * buf, int count )
150
151{ int k;
152
153 switch (pi->mode) {
154
155 case 0:
156 case 1: w0(0x68); P1;
157 for (k=0;k<count;k++) {
158 w2(5); w0(buf[k^1]); w2(7);
159 }
160 w2(5); w2(4);
161 break;
162
163 case 2: w3(0x48); (void)r1();
164 for (k=0;k<count;k++) w4(buf[k^1]);
165 break;
166
167 case 3: w3(0x48); (void)r1();
168 for (k=0;k<count/2;k++) w4w(pi_swab16(buf,k));
169 break;
170
171 case 4: w3(0x48); (void)r1();
172 for (k=0;k<count/4;k++) w4l(pi_swab32(buf,k));
173 break;
174
175
176 }
177}
178
179static void comm_log_adapter( PIA *pi, char * scratch, int verbose )
180
181{ char *mode_string[5] = {"4-bit","8-bit","EPP-8","EPP-16","EPP-32"};
182
183 printk("%s: comm %s, DataStor Commuter at 0x%x, ",
184 pi->device,COMM_VERSION,pi->port);
185 printk("mode %d (%s), delay %d\n",pi->mode,
186 mode_string[pi->mode],pi->delay);
187
188}
189
190static struct pi_protocol comm = {
191 .owner = THIS_MODULE,
192 .name = "comm",
193 .max_mode = 5,
194 .epp_first = 2,
195 .default_delay = 1,
196 .max_units = 1,
197 .write_regr = comm_write_regr,
198 .read_regr = comm_read_regr,
199 .write_block = comm_write_block,
200 .read_block = comm_read_block,
201 .connect = comm_connect,
202 .disconnect = comm_disconnect,
203 .log_adapter = comm_log_adapter,
204};
205
206static int __init comm_init(void)
207{
208 return paride_register(&comm);
209}
210
211static void __exit comm_exit(void)
212{
213 paride_unregister(&comm);
214}
215
216MODULE_LICENSE("GPL");
217module_init(comm_init)
218module_exit(comm_exit)
219
