Linux kernel & device driver programming

Cross-Referenced Linux and Device Driver Code

[ source navigation ] [ diff markup ] [ identifier search ] [ freetext search ] [ file search ]
Version: [ 2.6.11.8 ] [ 2.6.25 ] [ 2.6.25.8 ] [ 2.6.31.13 ] Architecture: [ i386 ]
  1 /*
  2         kbic.c    (c) 1997-8  Grant R. Guenther <grant@torque.net>
  3                               Under the terms of the GNU General Public License.
  4 
  5         This is a low-level driver for the KBIC-951A and KBIC-971A
  6         parallel to IDE adapter chips from KingByte Information Systems.
  7 
  8         The chips are almost identical, however, the wakeup code 
  9         required for the 971A interferes with the correct operation of
 10         the 951A, so this driver registers itself twice, once for
 11         each chip.
 12 
 13 */
 14 
 15 /* Changes:
 16 
 17         1.01    GRG 1998.05.06 init_proto, release_proto
 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 /* cont = 0 - access the IDE register file 
 40    cont = 1 - access the IDE command set 
 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 /* counts must be congruent to 0 MOD 4, but all known applications
131    have this property.
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)
306 
  This page was automatically generated by the LXR engine.