cachepc-linux

Fork of AMDESE/linux with modifications for CachePC side-channel attack
git clone https://git.sinitax.com/sinitax/cachepc-linux
Log | Files | Refs | README | LICENSE | sfeed.txt

fit2.c (3254B)

      1/* 
      2        fit2.c        (c) 1998  Grant R. Guenther <grant@torque.net>
      3                          Under the terms of the GNU General Public License.
      4
      5	fit2.c is a low-level protocol driver for the older version
      6        of the Fidelity International Technology parallel port adapter.  
      7	This adapter is used in their TransDisk 2000 and older TransDisk
      8	3000 portable hard-drives.  As far as I can tell, this device
      9	supports 4-bit mode _only_.  
     10
     11	Newer models of the FIT products use an enhanced protocol.
     12	The "fit3" protocol module should support current drives.
     13
     14*/
     15
     16#define FIT2_VERSION      "1.0"
     17
     18#include <linux/module.h>
     19#include <linux/init.h>
     20#include <linux/delay.h>
     21#include <linux/kernel.h>
     22#include <linux/types.h>
     23#include <linux/wait.h>
     24#include <asm/io.h>
     25
     26#include "paride.h"
     27
     28#define j44(a,b)                (((a>>4)&0x0f)|(b&0xf0))
     29
     30/* cont = 0 - access the IDE register file 
     31   cont = 1 - access the IDE command set 
     32
     33NB:  The FIT adapter does not appear to use the control registers.
     34So, we map ALT_STATUS to STATUS and NO-OP writes to the device
     35control register - this means that IDE reset will not work on these
     36devices.
     37
     38*/
     39
     40static void  fit2_write_regr( PIA *pi, int cont, int regr, int val)
     41
     42{	if (cont == 1) return;
     43	w2(0xc); w0(regr); w2(4); w0(val); w2(5); w0(0); w2(4);
     44}
     45
     46static int fit2_read_regr( PIA *pi, int cont, int regr )
     47
     48{	int  a, b, r;
     49
     50	if (cont) {
     51	  if (regr != 6) return 0xff;
     52	  r = 7;
     53	} else r = regr + 0x10;
     54
     55	w2(0xc); w0(r); w2(4); w2(5); 
     56	         w0(0); a = r1();
     57	         w0(1); b = r1();
     58	w2(4);
     59
     60	return j44(a,b);
     61
     62}
     63
     64static void fit2_read_block( PIA *pi, char * buf, int count )
     65
     66{	int  k, a, b, c, d;
     67
     68	w2(0xc); w0(0x10);
     69
     70	for (k=0;k<count/4;k++) {
     71
     72		w2(4); w2(5);
     73		w0(0); a = r1(); w0(1); b = r1();
     74		w0(3); c = r1(); w0(2); d = r1(); 
     75		buf[4*k+0] = j44(a,b);
     76		buf[4*k+1] = j44(d,c);
     77
     78                w2(4); w2(5);
     79                       a = r1(); w0(3); b = r1();
     80                w0(1); c = r1(); w0(0); d = r1(); 
     81                buf[4*k+2] = j44(d,c);
     82                buf[4*k+3] = j44(a,b);
     83
     84	}
     85
     86	w2(4);
     87
     88}
     89
     90static void fit2_write_block( PIA *pi, char * buf, int count )
     91
     92{	int k;
     93
     94
     95	w2(0xc); w0(0); 
     96	for (k=0;k<count/2;k++) {
     97		w2(4); w0(buf[2*k]); 
     98		w2(5); w0(buf[2*k+1]);
     99	}
    100	w2(4);
    101}
    102
    103static void fit2_connect ( PIA *pi  )
    104
    105{       pi->saved_r0 = r0();
    106        pi->saved_r2 = r2();
    107	w2(0xcc); 
    108}
    109
    110static void fit2_disconnect ( PIA *pi )
    111
    112{       w0(pi->saved_r0);
    113        w2(pi->saved_r2);
    114} 
    115
    116static void fit2_log_adapter( PIA *pi, char * scratch, int verbose )
    117
    118{       printk("%s: fit2 %s, FIT 2000 adapter at 0x%x, delay %d\n",
    119                pi->device,FIT2_VERSION,pi->port,pi->delay);
    120
    121}
    122
    123static struct pi_protocol fit2 = {
    124	.owner		= THIS_MODULE,
    125	.name		= "fit2",
    126	.max_mode	= 1,
    127	.epp_first	= 2,
    128	.default_delay	= 1,
    129	.max_units	= 1,
    130	.write_regr	= fit2_write_regr,
    131	.read_regr	= fit2_read_regr,
    132	.write_block	= fit2_write_block,
    133	.read_block	= fit2_read_block,
    134	.connect	= fit2_connect,
    135	.disconnect	= fit2_disconnect,
    136	.log_adapter	= fit2_log_adapter,
    137};
    138
    139static int __init fit2_init(void)
    140{
    141	return paride_register(&fit2);
    142}
    143
    144static void __exit fit2_exit(void)
    145{
    146	paride_unregister(&fit2);
    147}
    148
    149MODULE_LICENSE("GPL");
    150module_init(fit2_init)
    151module_exit(fit2_exit)