| /* |
| paride.c (c) 1997-8 Grant R. Guenther <grant@torque.net> |
| Under the terms of the GNU General Public License. |
| |
| This is the base module for the family of device drivers |
| that support parallel port IDE devices. |
| |
| */ |
| |
| /* Changes: |
| |
| 1.01 GRG 1998.05.03 Use spinlocks |
| 1.02 GRG 1998.05.05 init_proto, release_proto, ktti |
| 1.03 GRG 1998.08.15 eliminate compiler warning |
| 1.04 GRG 1998.11.28 added support for FRIQ |
| 1.05 TMW 2000.06.06 use parport_find_number instead of |
| parport_enumerate |
| 1.06 TMW 2001.03.26 more sane parport-or-not resource management |
| */ |
| |
| #define PI_VERSION "1.06" |
| |
| #include <linux/module.h> |
| #include <linux/config.h> |
| #include <linux/kmod.h> |
| #include <linux/types.h> |
| #include <linux/kernel.h> |
| #include <linux/ioport.h> |
| #include <linux/string.h> |
| #include <linux/spinlock.h> |
| #include <linux/wait.h> |
| |
| #ifdef CONFIG_PARPORT_MODULE |
| #define CONFIG_PARPORT |
| #endif |
| |
| #ifdef CONFIG_PARPORT |
| #include <linux/parport.h> |
| #endif |
| |
| #include "paride.h" |
| |
| #define MAX_PROTOS 32 |
| |
| static struct pi_protocol *protocols[MAX_PROTOS]; |
| |
| static spinlock_t pi_spinlock = SPIN_LOCK_UNLOCKED; |
| |
| void pi_write_regr( PIA *pi, int cont, int regr, int val) |
| |
| { pi->proto->write_regr(pi,cont,regr,val); |
| } |
| |
| int pi_read_regr( PIA *pi, int cont, int regr) |
| |
| { return pi->proto->read_regr(pi,cont,regr); |
| } |
| |
| void pi_write_block( PIA *pi, char * buf, int count) |
| |
| { pi->proto->write_block(pi,buf,count); |
| } |
| |
| void pi_read_block( PIA *pi, char * buf, int count) |
| |
| { pi->proto->read_block(pi,buf,count); |
| } |
| |
| #ifdef CONFIG_PARPORT |
| |
| static void pi_wake_up( void *p) |
| |
| { PIA *pi = (PIA *) p; |
| unsigned long flags; |
| void (*cont)(void) = NULL; |
| |
| spin_lock_irqsave(&pi_spinlock,flags); |
| |
| if (pi->claim_cont && !parport_claim(pi->pardev)) { |
| cont = pi->claim_cont; |
| pi->claim_cont = NULL; |
| pi->claimed = 1; |
| } |
| |
| spin_unlock_irqrestore(&pi_spinlock,flags); |
| |
| wake_up(&(pi->parq)); |
| |
| if (cont) cont(); |
| } |
| |
| #endif |
| |
| void pi_do_claimed( PIA *pi, void(*cont)(void)) |
| |
| #ifdef CONFIG_PARPORT |
| |
| { unsigned long flags; |
| |
| spin_lock_irqsave(&pi_spinlock,flags); |
| |
| if (!pi->pardev || !parport_claim(pi->pardev)) { |
| pi->claimed = 1; |
| spin_unlock_irqrestore(&pi_spinlock,flags); |
| cont(); |
| } else { |
| pi->claim_cont = cont; |
| spin_unlock_irqrestore(&pi_spinlock,flags); |
| } |
| } |
| |
| #else |
| |
| { cont(); |
| } |
| |
| #endif |
| |
| static void pi_claim( PIA *pi) |
| |
| { if (pi->claimed) return; |
| pi->claimed = 1; |
| #ifdef CONFIG_PARPORT |
| if (pi->pardev) |
| wait_event (pi->parq, |
| !parport_claim ((struct pardevice *)pi->pardev)); |
| #endif |
| } |
| |
| static void pi_unclaim( PIA *pi) |
| |
| { pi->claimed = 0; |
| #ifdef CONFIG_PARPORT |
| if (pi->pardev) parport_release((struct pardevice *)(pi->pardev)); |
| #endif |
| } |
| |
| void pi_connect( PIA *pi) |
| |
| { pi_claim(pi); |
| pi->proto->connect(pi); |
| } |
| |
| void pi_disconnect( PIA *pi) |
| |
| { pi->proto->disconnect(pi); |
| pi_unclaim(pi); |
| } |
| |
| static void pi_unregister_parport( PIA *pi) |
| |
| { |
| #ifdef CONFIG_PARPORT |
| if (pi->pardev) { |
| parport_unregister_device((struct pardevice *)(pi->pardev)); |
| pi->pardev = NULL; |
| } |
| #endif |
| } |
| |
| void pi_release( PIA *pi) |
| |
| { pi_unregister_parport(pi); |
| #ifndef CONFIG_PARPORT |
| if (pi->reserved) |
| release_region(pi->port,pi->reserved); |
| #endif /* !CONFIG_PARPORT */ |
| pi->proto->release_proto(pi); |
| } |
| |
| #define WR(r,v) pi_write_regr(pi,0,r,v) |
| #define RR(r) (pi_read_regr(pi,0,r)) |
| |
| static int pi_test_proto( PIA *pi, char * scratch, int verbose ) |
| |
| { int j, k; |
| int e[2] = {0,0}; |
| |
| if (pi->proto->test_proto) { |
| pi_claim(pi); |
| j = pi->proto->test_proto(pi,scratch,verbose); |
| pi_unclaim(pi); |
| return j; |
| } |
| |
| pi_connect(pi); |
| |
| for (j=0;j<2;j++) { |
| WR(6,0xa0+j*0x10); |
| for (k=0;k<256;k++) { |
| WR(2,k^0xaa); |
| WR(3,k^0x55); |
| if (RR(2) != (k^0xaa)) e[j]++; |
| } |
| } |
| |
| pi_disconnect(pi); |
| |
| if (verbose) |
| printk("%s: %s: port 0x%x, mode %d, test=(%d,%d)\n", |
| pi->device,pi->proto->name,pi->port, |
| pi->mode,e[0],e[1]); |
| |
| return (e[0] && e[1]); /* not here if both > 0 */ |
| } |
| |
| int pi_register( PIP *pr) |
| |
| { int k; |
| |
| for (k=0;k<MAX_PROTOS;k++) |
| if (protocols[k] && !strcmp(pr->name,protocols[k]->name)) { |
| printk("paride: %s protocol already registered\n",pr->name); |
| return 0; |
| } |
| k = 0; |
| while((k<MAX_PROTOS) && (protocols[k])) k++; |
| if (k == MAX_PROTOS) { |
| printk("paride: protocol table full\n"); |
| return 0; |
| } |
| MOD_INC_USE_COUNT; |
| protocols[k] = pr; |
| pr->index = k; |
| printk("paride: %s registered as protocol %d\n",pr->name,k); |
| return 1; |
| } |
| |
| void pi_unregister( PIP *pr) |
| |
| { if (!pr) return; |
| if (protocols[pr->index] != pr) { |
| printk("paride: %s not registered\n",pr->name); |
| return; |
| } |
| protocols[pr->index] = 0; |
| MOD_DEC_USE_COUNT; |
| } |
| |
| static int pi_register_parport( PIA *pi, int verbose) |
| |
| { |
| #ifdef CONFIG_PARPORT |
| |
| struct parport *port; |
| |
| port = parport_find_base (pi->port); |
| if (!port) |
| return 0; |
| |
| pi->pardev = parport_register_device(port, |
| pi->device,NULL, |
| pi_wake_up,NULL, |
| 0,(void *)pi); |
| parport_put_port (port); |
| if (!pi->pardev) |
| return 0; |
| |
| init_waitqueue_head(&pi->parq); |
| |
| if (verbose) printk("%s: 0x%x is %s\n",pi->device,pi->port, |
| port->name); |
| |
| pi->parname = (char *)port->name; |
| #endif |
| |
| return 1; |
| } |
| |
| static int pi_probe_mode( PIA *pi, int max, char * scratch, int verbose) |
| |
| { int best, range; |
| |
| if (pi->mode != -1) { |
| if (pi->mode >= max) return 0; |
| range = 3; |
| if (pi->mode >= pi->proto->epp_first) range = 8; |
| if ((range == 8) && (pi->port % 8)) return 0; |
| pi->reserved = range; |
| return (!pi_test_proto(pi,scratch,verbose)); |
| } |
| best = -1; |
| for(pi->mode=0;pi->mode<max;pi->mode++) { |
| range = 3; |
| if (pi->mode >= pi->proto->epp_first) range = 8; |
| if ((range == 8) && (pi->port % 8)) break; |
| pi->reserved = range; |
| if (!pi_test_proto(pi,scratch,verbose)) best = pi->mode; |
| } |
| pi->mode = best; |
| return (best > -1); |
| } |
| |
| static int pi_probe_unit( PIA *pi, int unit, char * scratch, int verbose) |
| |
| { int max,s,e; |
| |
| s = unit; e = s+1; |
| |
| if (s == -1) { |
| s = 0; |
| e = pi->proto->max_units; |
| } |
| |
| if (!pi_register_parport(pi,verbose)) |
| return 0; |
| |
| if (pi->proto->test_port) { |
| pi_claim(pi); |
| max = pi->proto->test_port(pi); |
| pi_unclaim(pi); |
| } |
| else max = pi->proto->max_mode; |
| |
| if (pi->proto->probe_unit) { |
| pi_claim(pi); |
| for (pi->unit=s;pi->unit<e;pi->unit++) |
| if (pi->proto->probe_unit(pi)) { |
| pi_unclaim(pi); |
| if (pi_probe_mode(pi,max,scratch,verbose)) return 1; |
| pi_unregister_parport(pi); |
| return 0; |
| } |
| pi_unclaim(pi); |
| pi_unregister_parport(pi); |
| return 0; |
| } |
| |
| if (!pi_probe_mode(pi,max,scratch,verbose)) { |
| pi_unregister_parport(pi); |
| return 0; |
| } |
| return 1; |
| |
| } |
| |
| int pi_init(PIA *pi, int autoprobe, int port, int mode, |
| int unit, int protocol, int delay, char * scratch, |
| int devtype, int verbose, char *device ) |
| |
| { int p,k,s,e; |
| int lpts[7] = {0x3bc,0x378,0x278,0x268,0x27c,0x26c,0}; |
| |
| s = protocol; e = s+1; |
| |
| if (!protocols[0]) |
| request_module ("paride_protocol"); |
| |
| if (autoprobe) { |
| s = 0; |
| e = MAX_PROTOS; |
| } else if ((s < 0) || (s >= MAX_PROTOS) || (port <= 0) || |
| (!protocols[s]) || (unit < 0) || |
| (unit >= protocols[s]->max_units)) { |
| printk("%s: Invalid parameters\n",device); |
| return 0; |
| } |
| |
| for (p=s;p<e;p++) { |
| if (protocols[p]) { |
| pi->proto = protocols[p]; |
| pi->private = 0; |
| pi->proto->init_proto(pi); |
| if (delay == -1) pi->delay = pi->proto->default_delay; |
| else pi->delay = delay; |
| pi->devtype = devtype; |
| pi->device = device; |
| |
| pi->parname = NULL; |
| pi->pardev = NULL; |
| init_waitqueue_head(&pi->parq); |
| pi->claimed = 0; |
| pi->claim_cont = NULL; |
| |
| pi->mode = mode; |
| if (port != -1) { |
| pi->port = port; |
| if (pi_probe_unit(pi,unit,scratch,verbose)) break; |
| pi->port = 0; |
| } else { |
| k = 0; |
| while ((pi->port = lpts[k++])) |
| if (pi_probe_unit(pi,unit,scratch,verbose)) break; |
| if (pi->port) break; |
| } |
| pi->proto->release_proto(pi); |
| } |
| } |
| |
| if (!pi->port) { |
| if (autoprobe) printk("%s: Autoprobe failed\n",device); |
| else printk("%s: Adapter not found\n",device); |
| return 0; |
| } |
| |
| #ifndef CONFIG_PARPORT |
| if (!request_region(pi->port,pi->reserved,pi->device)) |
| { |
| printk(KERN_WARNING"paride: Unable to request region 0x%x\n", pi->port); |
| return 0; |
| } |
| #endif /* !CONFIG_PARPORT */ |
| |
| if (pi->parname) |
| printk("%s: Sharing %s at 0x%x\n",pi->device, |
| pi->parname,pi->port); |
| |
| pi->proto->log_adapter(pi,scratch,verbose); |
| |
| return 1; |
| } |
| |
| #ifdef MODULE |
| |
| int init_module(void) |
| |
| { |
| int k; |
| const char *indicate_pp = ""; |
| #ifdef CONFIG_PARPORT |
| indicate_pp = " (parport)"; |
| #endif |
| |
| for (k=0;k<MAX_PROTOS;k++) protocols[k] = 0; |
| |
| printk("paride: version %s installed%s\n",PI_VERSION,indicate_pp); |
| return 0; |
| } |
| |
| void cleanup_module(void) |
| |
| { |
| } |
| |
| #else |
| |
| void paride_init( void ) |
| |
| { |
| |
| #ifdef CONFIG_PARIDE_ATEN |
| { extern struct pi_protocol aten; |
| pi_register(&aten); |
| }; |
| #endif |
| #ifdef CONFIG_PARIDE_BPCK |
| { extern struct pi_protocol bpck; |
| pi_register(&bpck); |
| }; |
| #endif |
| #ifdef CONFIG_PARIDE_COMM |
| { extern struct pi_protocol comm; |
| pi_register(&comm); |
| }; |
| #endif |
| #ifdef CONFIG_PARIDE_DSTR |
| { extern struct pi_protocol dstr; |
| pi_register(&dstr); |
| }; |
| #endif |
| #ifdef CONFIG_PARIDE_EPAT |
| { extern struct pi_protocol epat; |
| pi_register(&epat); |
| }; |
| #endif |
| #ifdef CONFIG_PARIDE_EPIA |
| { extern struct pi_protocol epia; |
| pi_register(&epia); |
| }; |
| #endif |
| #ifdef CONFIG_PARIDE_FRPW |
| { extern struct pi_protocol frpw; |
| pi_register(&frpw); |
| }; |
| #endif |
| #ifdef CONFIG_PARIDE_FRIQ |
| { extern struct pi_protocol friq; |
| pi_register(&friq); |
| }; |
| #endif |
| #ifdef CONFIG_PARIDE_FIT2 |
| { extern struct pi_protocol fit2; |
| pi_register(&fit2); |
| }; |
| #endif |
| #ifdef CONFIG_PARIDE_FIT3 |
| { extern struct pi_protocol fit3; |
| pi_register(&fit3); |
| }; |
| #endif |
| #ifdef CONFIG_PARIDE_KBIC |
| { extern struct pi_protocol k951; |
| extern struct pi_protocol k971; |
| pi_register(&k951); |
| pi_register(&k971); |
| }; |
| #endif |
| #ifdef CONFIG_PARIDE_KTTI |
| { extern struct pi_protocol ktti; |
| pi_register(&ktti); |
| }; |
| #endif |
| #ifdef CONFIG_PARIDE_ON20 |
| { extern struct pi_protocol on20; |
| pi_register(&on20); |
| }; |
| #endif |
| #ifdef CONFIG_PARIDE_ON26 |
| { extern struct pi_protocol on26; |
| pi_register(&on26); |
| }; |
| #endif |
| |
| #ifdef CONFIG_PARIDE_PD |
| { extern int pd_init(void); |
| pd_init(); |
| }; |
| #endif |
| #ifdef CONFIG_PARIDE_PCD |
| { extern int pcd_init(void); |
| pcd_init(); |
| }; |
| #endif |
| #ifdef CONFIG_PARIDE_PF |
| { extern int pf_init(void); |
| pf_init(); |
| }; |
| #endif |
| #ifdef CONFIG_PARIDE_PT |
| { extern int pt_init(void); |
| pt_init(); |
| }; |
| #endif |
| #ifdef CONFIG_PARIDE_PG |
| { extern int pg_init(void); |
| pg_init(); |
| }; |
| #endif |
| } |
| |
| #endif |
| |
| /* end of paride.c */ |
| MODULE_LICENSE("GPL"); |