linux/drivers/block/paride/bpck.c
<<
>>
Prefs
   1/* 
   2        bpck.c  (c) 1996-8  Grant R. Guenther <grant@torque.net>
   3                            Under the terms of the GNU General Public License.
   4
   5        bpck.c is a low-level protocol driver for the MicroSolutions 
   6        "backpack" parallel port IDE adapter.  
   7
   8*/
   9
  10/* Changes:
  11
  12        1.01    GRG 1998.05.05 init_proto, release_proto, pi->delay 
  13        1.02    GRG 1998.08.15 default pi->delay returned to 4
  14
  15*/
  16
  17#define BPCK_VERSION    "1.02" 
  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#undef r2
  30#undef w2
  31
  32#define PC                      pi->private
  33#define r2()                    (PC=(in_p(2) & 0xff))
  34#define w2(byte)                {out_p(2,byte); PC = byte;}
  35#define t2(pat)                 {PC ^= pat; out_p(2,PC);}
  36#define e2()                    {PC &= 0xfe; out_p(2,PC);}
  37#define o2()                    {PC |= 1; out_p(2,PC);}
  38
  39#define j44(l,h)     (((l>>3)&0x7)|((l>>4)&0x8)|((h<<1)&0x70)|(h&0x80))
  40
  41/* cont = 0 - access the IDE register file 
  42   cont = 1 - access the IDE command set 
  43   cont = 2 - use internal bpck register addressing
  44*/
  45
  46static int  cont_map[3] = { 0x40, 0x48, 0 };
  47
  48static int bpck_read_regr( PIA *pi, int cont, int regr )
  49
  50{       int r, l, h;
  51
  52        r = regr + cont_map[cont];
  53
  54        switch (pi->mode) {
  55
  56        case 0: w0(r & 0xf); w0(r); t2(2); t2(4);
  57                l = r1();
  58                t2(4);
  59                h = r1();
  60                return j44(l,h);
  61
  62        case 1: w0(r & 0xf); w0(r); t2(2);
  63                e2(); t2(0x20);
  64                t2(4); h = r0();
  65                t2(1); t2(0x20);
  66                return h;
  67
  68        case 2:
  69        case 3:
  70        case 4: w0(r); w2(9); w2(0); w2(0x20);
  71                h = r4();
  72                w2(0);
  73                return h;
  74
  75        }
  76        return -1;
  77}       
  78
  79static void bpck_write_regr( PIA *pi, int cont, int regr, int val )
  80
  81{       int     r;
  82
  83        r = regr + cont_map[cont];
  84
  85        switch (pi->mode) {
  86
  87        case 0:
  88        case 1: w0(r);
  89                t2(2);
  90                w0(val);
  91                o2(); t2(4); t2(1);
  92                break;
  93
  94        case 2:
  95        case 3:
  96        case 4: w0(r); w2(9); w2(0);
  97                w0(val); w2(1); w2(3); w2(0);
  98                break;
  99
 100        }
 101}
 102
 103/* These macros access the bpck registers in native addressing */
 104
 105#define WR(r,v)         bpck_write_regr(pi,2,r,v)
 106#define RR(r)           (bpck_read_regr(pi,2,r))
 107
 108static void bpck_write_block( PIA *pi, char * buf, int count )
 109
 110{       int i;
 111
 112        switch (pi->mode) {
 113
 114        case 0: WR(4,0x40);
 115                w0(0x40); t2(2); t2(1);
 116                for (i=0;i<count;i++) { w0(buf[i]); t2(4); }
 117                WR(4,0);
 118                break;
 119
 120        case 1: WR(4,0x50);
 121                w0(0x40); t2(2); t2(1);
 122                for (i=0;i<count;i++) { w0(buf[i]); t2(4); }
 123                WR(4,0x10);
 124                break;
 125
 126        case 2: WR(4,0x48);
 127                w0(0x40); w2(9); w2(0); w2(1);
 128                for (i=0;i<count;i++) w4(buf[i]);
 129                w2(0);
 130                WR(4,8);
 131                break;
 132
 133        case 3: WR(4,0x48);
 134                w0(0x40); w2(9); w2(0); w2(1);
 135                for (i=0;i<count/2;i++) w4w(((u16 *)buf)[i]);
 136                w2(0);
 137                WR(4,8);
 138                break;
 139 
 140        case 4: WR(4,0x48);
 141                w0(0x40); w2(9); w2(0); w2(1);
 142                for (i=0;i<count/4;i++) w4l(((u32 *)buf)[i]);
 143                w2(0);
 144                WR(4,8);
 145                break;
 146        }
 147}
 148
 149static void bpck_read_block( PIA *pi, char * buf, int count )
 150
 151{       int i, l, h;
 152
 153        switch (pi->mode) {
 154
 155        case 0: WR(4,0x40);
 156                w0(0x40); t2(2);
 157                for (i=0;i<count;i++) {
 158                    t2(4); l = r1();
 159                    t2(4); h = r1();
 160                    buf[i] = j44(l,h);
 161                }
 162                WR(4,0);
 163                break;
 164
 165        case 1: WR(4,0x50);
 166                w0(0x40); t2(2); t2(0x20);
 167                for(i=0;i<count;i++) { t2(4); buf[i] = r0(); }
 168                t2(1); t2(0x20);
 169                WR(4,0x10);
 170                break;
 171
 172        case 2: WR(4,0x48);
 173                w0(0x40); w2(9); w2(0); w2(0x20);
 174                for (i=0;i<count;i++) buf[i] = r4();
 175                w2(0);
 176                WR(4,8);
 177                break;
 178
 179        case 3: WR(4,0x48);
 180                w0(0x40); w2(9); w2(0); w2(0x20);
 181                for (i=0;i<count/2;i++) ((u16 *)buf)[i] = r4w();
 182                w2(0);
 183                WR(4,8);
 184                break;
 185
 186        case 4: WR(4,0x48);
 187                w0(0x40); w2(9); w2(0); w2(0x20);
 188                for (i=0;i<count/4;i++) ((u32 *)buf)[i] = r4l();
 189                w2(0);
 190                WR(4,8);
 191                break;
 192
 193        }
 194}
 195
 196static int bpck_probe_unit ( PIA *pi )
 197
 198{       int o1, o0, f7, id;
 199        int t, s;
 200
 201        id = pi->unit;
 202        s = 0;
 203        w2(4); w2(0xe); r2(); t2(2); 
 204        o1 = r1()&0xf8;
 205        o0 = r0();
 206        w0(255-id); w2(4); w0(id);
 207        t2(8); t2(8); t2(8);
 208        t2(2); t = r1()&0xf8;
 209        f7 = ((id % 8) == 7);
 210        if ((f7) || (t != o1)) { t2(2); s = r1()&0xf8; }
 211        if ((t == o1) && ((!f7) || (s == o1)))  {
 212                w2(0x4c); w0(o0);
 213                return 0;       
 214        }
 215        t2(8); w0(0); t2(2); w2(0x4c); w0(o0);
 216        return 1;
 217}
 218        
 219static void bpck_connect ( PIA *pi  )
 220
 221{       pi->saved_r0 = r0();
 222        w0(0xff-pi->unit); w2(4); w0(pi->unit);
 223        t2(8); t2(8); t2(8); 
 224        t2(2); t2(2);
 225        
 226        switch (pi->mode) {
 227
 228        case 0: t2(8); WR(4,0);
 229                break;
 230
 231        case 1: t2(8); WR(4,0x10);
 232                break;
 233
 234        case 2:
 235        case 3:
 236        case 4: w2(0); WR(4,8);
 237                break;
 238
 239        }
 240
 241        WR(5,8);
 242
 243        if (pi->devtype == PI_PCD) {
 244                WR(0x46,0x10);          /* fiddle with ESS logic ??? */
 245                WR(0x4c,0x38);
 246                WR(0x4d,0x88);
 247                WR(0x46,0xa0);
 248                WR(0x41,0);
 249                WR(0x4e,8);
 250                }
 251}
 252
 253static void bpck_disconnect ( PIA *pi )
 254
 255{       w0(0); 
 256        if (pi->mode >= 2) { w2(9); w2(0); } else t2(2);
 257        w2(0x4c); w0(pi->saved_r0);
 258} 
 259
 260static void bpck_force_spp ( PIA *pi )
 261
 262/* This fakes the EPP protocol to turn off EPP ... */
 263
 264{       pi->saved_r0 = r0();
 265        w0(0xff-pi->unit); w2(4); w0(pi->unit);
 266        t2(8); t2(8); t2(8); 
 267        t2(2); t2(2);
 268
 269        w2(0); 
 270        w0(4); w2(9); w2(0); 
 271        w0(0); w2(1); w2(3); w2(0);     
 272        w0(0); w2(9); w2(0);
 273        w2(0x4c); w0(pi->saved_r0);
 274}
 275
 276#define TEST_LEN  16
 277
 278static int bpck_test_proto( PIA *pi, char * scratch, int verbose )
 279
 280{       int i, e, l, h, om;
 281        char buf[TEST_LEN];
 282
 283        bpck_force_spp(pi);
 284
 285        switch (pi->mode) {
 286
 287        case 0: bpck_connect(pi);
 288                WR(0x13,0x7f);
 289                w0(0x13); t2(2);
 290                for(i=0;i<TEST_LEN;i++) {
 291                    t2(4); l = r1();
 292                    t2(4); h = r1();
 293                    buf[i] = j44(l,h);
 294                }
 295                bpck_disconnect(pi);
 296                break;
 297
 298        case 1: bpck_connect(pi);
 299                WR(0x13,0x7f);
 300                w0(0x13); t2(2); t2(0x20);
 301                for(i=0;i<TEST_LEN;i++) { t2(4); buf[i] = r0(); }
 302                t2(1); t2(0x20);
 303                bpck_disconnect(pi);
 304                break;
 305
 306        case 2:
 307        case 3:
 308        case 4: om = pi->mode;
 309                pi->mode = 0;
 310                bpck_connect(pi);
 311                WR(7,3);
 312                WR(4,8);
 313                bpck_disconnect(pi);
 314
 315                pi->mode = om;
 316                bpck_connect(pi);
 317                w0(0x13); w2(9); w2(1); w0(0); w2(3); w2(0); w2(0xe0);
 318
 319                switch (pi->mode) {
 320                  case 2: for (i=0;i<TEST_LEN;i++) buf[i] = r4();
 321                          break;
 322                  case 3: for (i=0;i<TEST_LEN/2;i++) ((u16 *)buf)[i] = r4w();
 323                          break;
 324                  case 4: for (i=0;i<TEST_LEN/4;i++) ((u32 *)buf)[i] = r4l();
 325                          break;
 326                }
 327
 328                w2(0);
 329                WR(7,0);
 330                bpck_disconnect(pi);
 331
 332                break;
 333
 334        }
 335
 336        if (verbose) {
 337            printk("%s: bpck: 0x%x unit %d mode %d: ",
 338                   pi->device,pi->port,pi->unit,pi->mode);
 339            for (i=0;i<TEST_LEN;i++) printk("%3d",buf[i]);
 340            printk("\n");
 341        }
 342
 343        e = 0;
 344        for (i=0;i<TEST_LEN;i++) if (buf[i] != (i+1)) e++;
 345        return e;
 346}
 347
 348static void bpck_read_eeprom ( PIA *pi, char * buf )
 349
 350{       int i,j,k,n,p,v,f, om, od;
 351
 352        bpck_force_spp(pi);
 353
 354        om = pi->mode;  od = pi->delay;
 355        pi->mode = 0; pi->delay = 6;
 356
 357        bpck_connect(pi);
 358        
 359        n = 0;
 360        WR(4,0);
 361        for (i=0;i<64;i++) {
 362            WR(6,8);  
 363            WR(6,0xc);
 364            p = 0x100;
 365            for (k=0;k<9;k++) {
 366                f = (((i + 0x180) & p) != 0) * 2;
 367                WR(6,f+0xc); 
 368                WR(6,f+0xd); 
 369                WR(6,f+0xc);
 370                p = (p >> 1);
 371            }
 372            for (j=0;j<2;j++) {
 373                v = 0;
 374                for (k=0;k<8;k++) {
 375                    WR(6,0xc); 
 376                    WR(6,0xd); 
 377                    WR(6,0xc); 
 378                    f = RR(0);
 379                    v = 2*v + (f == 0x84);
 380                }
 381                buf[2*i+1-j] = v;
 382            }
 383        }
 384        WR(6,8);
 385        WR(6,0);
 386        WR(5,8);
 387
 388        bpck_disconnect(pi);
 389
 390        if (om >= 2) {
 391                bpck_connect(pi);
 392                WR(7,3);
 393                WR(4,8);
 394                bpck_disconnect(pi);
 395        }
 396
 397        pi->mode = om; pi->delay = od;
 398}
 399
 400static int bpck_test_port ( PIA *pi )   /* check for 8-bit port */
 401
 402{       int     i, r, m;
 403
 404        w2(0x2c); i = r0(); w0(255-i); r = r0(); w0(i);
 405        m = -1;
 406        if (r == i) m = 2;
 407        if (r == (255-i)) m = 0;
 408
 409        w2(0xc); i = r0(); w0(255-i); r = r0(); w0(i);
 410        if (r != (255-i)) m = -1;
 411        
 412        if (m == 0) { w2(6); w2(0xc); r = r0(); w0(0xaa); w0(r); w0(0xaa); }
 413        if (m == 2) { w2(0x26); w2(0xc); }
 414
 415        if (m == -1) return 0;
 416        return 5;
 417}
 418
 419static void bpck_log_adapter( PIA *pi, char * scratch, int verbose )
 420
 421{       char    *mode_string[5] = { "4-bit","8-bit","EPP-8",
 422                                    "EPP-16","EPP-32" };
 423
 424#ifdef DUMP_EEPROM
 425        int i;
 426#endif
 427
 428        bpck_read_eeprom(pi,scratch);
 429
 430#ifdef DUMP_EEPROM
 431        if (verbose) {
 432           for(i=0;i<128;i++)
 433                if ((scratch[i] < ' ') || (scratch[i] > '~'))
 434                    scratch[i] = '.';
 435           printk("%s: bpck EEPROM: %64.64s\n",pi->device,scratch);
 436           printk("%s:              %64.64s\n",pi->device,&scratch[64]);
 437        }
 438#endif
 439
 440        printk("%s: bpck %s, backpack %8.8s unit %d",
 441                pi->device,BPCK_VERSION,&scratch[110],pi->unit);
 442        printk(" at 0x%x, mode %d (%s), delay %d\n",pi->port,
 443                pi->mode,mode_string[pi->mode],pi->delay);
 444}
 445
 446static struct pi_protocol bpck = {
 447        .owner          = THIS_MODULE,
 448        .name           = "bpck",
 449        .max_mode       = 5,
 450        .epp_first      = 2,
 451        .default_delay  = 4,
 452        .max_units      = 255,
 453        .write_regr     = bpck_write_regr,
 454        .read_regr      = bpck_read_regr,
 455        .write_block    = bpck_write_block,
 456        .read_block     = bpck_read_block,
 457        .connect        = bpck_connect,
 458        .disconnect     = bpck_disconnect,
 459        .test_port      = bpck_test_port,
 460        .probe_unit     = bpck_probe_unit,
 461        .test_proto     = bpck_test_proto,
 462        .log_adapter    = bpck_log_adapter,
 463};
 464
 465static int __init bpck_init(void)
 466{
 467        return paride_register(&bpck);
 468}
 469
 470static void __exit bpck_exit(void)
 471{
 472        paride_unregister(&bpck);
 473}
 474
 475MODULE_LICENSE("GPL");
 476module_init(bpck_init)
 477module_exit(bpck_exit)
 478