/* dstr.c (c) 1997-8 Grant R. Guenther <grant@torque.net> Under the terms of the GNU General Public License. dstr.c is a low-level protocol driver for the DataStor EP2000 parallel to IDE adapter chip. */ /* Changes: 1.01 GRG 1998.05.06 init_proto, release_proto */ #define DSTR_VERSION "1.01" #include <linux/module.h> #include <linux/init.h> #include <linux/delay.h> #include <linux/kernel.h> #include <linux/types.h> #include <linux/wait.h> #include <asm/io.h> #include "paride.h" /* mode codes: 0 nybble reads, 8-bit writes 1 8-bit reads and writes 2 8-bit EPP mode 3 EPP-16 4 EPP-32 */ #define j44(a,b) (((a>>3)&0x07)|((~a>>4)&0x08)|((b<<1)&0x70)|((~b)&0x80)) #define P1 w2(5);w2(0xd);w2(5);w2(4); #define P2 w2(5);w2(7);w2(5);w2(4); #define P3 w2(6);w2(4);w2(6);w2(4); /* cont = 0 - access the IDE register file cont = 1 - access the IDE command set */ static int cont_map[2] = { 0x20, 0x40 }; static int dstr_read_regr( PIA *pi, int cont, int regr ) { int a, b, r; r = regr + cont_map[cont]; w0(0x81); P1; if (pi->mode) { w0(0x11); } else { w0(1); } P2; w0(r); P1; switch (pi->mode) { case 0: w2(6); a = r1(); w2(4); w2(6); b = r1(); w2(4); return j44(a,b); case 1: w0(0); w2(0x26); a = r0(); w2(4); return a; case 2: case 3: case 4: w2(0x24); a = r4(); w2(4); return a; } return -1; } static void dstr_write_regr( PIA *pi, int cont, int regr, int val ) { int r; r = regr + cont_map[cont]; w0(0x81); P1; if (pi->mode >= 2) { w0(0x11); } else { w0(1); } P2; w0(r); P1; switch (pi->mode) { case 0: case 1: w0(val); w2(5); w2(7); w2(5); w2(4); break; case 2: case 3: case 4: w4(val); break; } } #define CCP(x) w0(0xff);w2(0xc);w2(4);\ w0(0xaa);w0(0x55);w0(0);w0(0xff);w0(0x87);w0(0x78);\ w0(x);w2(5);w2(4); static void dstr_connect ( PIA *pi ) { pi->saved_r0 = r0(); pi->saved_r2 = r2(); w2(4); CCP(0xe0); w0(0xff); } static void dstr_disconnect ( PIA *pi ) { CCP(0x30); w0(pi->saved_r0); w2(pi->saved_r2); } static void dstr_read_block( PIA *pi, char * buf, int count ) { int k, a, b; w0(0x81); P1; if (pi->mode) { w0(0x19); } else { w0(9); } P2; w0(0x82); P1; P3; w0(0x20); P1; switch (pi->mode) { case 0: for (k=0;k<count;k++) { w2(6); a = r1(); w2(4); w2(6); b = r1(); w2(4); buf[k] = j44(a,b); } break; case 1: w0(0); for (k=0;k<count;k++) { w2(0x26); buf[k] = r0(); w2(0x24); } w2(4); break; case 2: w2(0x24); for (k=0;k<count;k++) buf[k] = r4(); w2(4); break; case 3: w2(0x24); for (k=0;k<count/2;k++) ((u16 *)buf)[k] = r4w(); w2(4); break; case 4: w2(0x24); for (k=0;k<count/4;k++) ((u32 *)buf)[k] = r4l(); w2(4); break; } } static void dstr_write_block( PIA *pi, char * buf, int count ) { int k; w0(0x81); P1; if (pi->mode) { w0(0x19); } else { w0(9); } P2; w0(0x82); P1; P3; w0(0x20); P1; switch (pi->mode) { case 0: case 1: for (k=0;k<count;k++) { w2(5); w0(buf[k]); w2(7); } w2(5); w2(4); break; case 2: w2(0xc5); for (k=0;k<count;k++) w4(buf[k]); w2(0xc4); break; case 3: w2(0xc5); for (k=0;k<count/2;k++) w4w(((u16 *)buf)[k]); w2(0xc4); break; case 4: w2(0xc5); for (k=0;k<count/4;k++) w4l(((u32 *)buf)[k]); w2(0xc4); break; } } static void dstr_log_adapter( PIA *pi, char * scratch, int verbose ) { char *mode_string[5] = {"4-bit","8-bit","EPP-8", "EPP-16","EPP-32"}; printk("%s: dstr %s, DataStor EP2000 at 0x%x, ", pi->device,DSTR_VERSION,pi->port); printk("mode %d (%s), delay %d\n",pi->mode, mode_string[pi->mode],pi->delay); } static struct pi_protocol dstr = { .owner = THIS_MODULE, .name = "dstr", .max_mode = 5, .epp_first = 2, .default_delay = 1, .max_units = 1, .write_regr = dstr_write_regr, .read_regr = dstr_read_regr, .write_block = dstr_write_block, .read_block = dstr_read_block, .connect = dstr_connect, .disconnect = dstr_disconnect, .log_adapter = dstr_log_adapter, }; static int __init dstr_init(void) { return pi_register(&dstr)-1; } static void __exit dstr_exit(void) { pi_unregister(&dstr); } MODULE_LICENSE("GPL"); module_init(dstr_init) module_exit(dstr_exit)