506 lines
8.4 KiB
C
506 lines
8.4 KiB
C
// SPDX-License-Identifier: GPL-2.0-or-later
|
|
/*
|
|
* (c) 1996-1998 Grant R. Guenther <grant@torque.net>
|
|
*
|
|
* bpck.c is a low-level protocol driver for the MicroSolutions
|
|
* "backpack" parallel port IDE adapter.
|
|
*/
|
|
|
|
#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 "pata_parport.h"
|
|
|
|
#undef r2
|
|
#undef w2
|
|
#undef PC
|
|
|
|
#define PC pi->private
|
|
#define r2() (PC=(in_p(2) & 0xff))
|
|
#define w2(byte) {out_p(2,byte); PC = byte;}
|
|
#define t2(pat) {PC ^= pat; out_p(2,PC);}
|
|
#define e2() {PC &= 0xfe; out_p(2,PC);}
|
|
#define o2() {PC |= 1; out_p(2,PC);}
|
|
|
|
#define j44(l,h) (((l>>3)&0x7)|((l>>4)&0x8)|((h<<1)&0x70)|(h&0x80))
|
|
|
|
/*
|
|
* cont = 0 - access the IDE register file
|
|
* cont = 1 - access the IDE command set
|
|
* cont = 2 - use internal bpck register addressing
|
|
*/
|
|
static int cont_map[3] = { 0x40, 0x48, 0 };
|
|
|
|
static int bpck_read_regr(struct pi_adapter *pi, int cont, int regr)
|
|
{
|
|
int r, l, h;
|
|
|
|
r = regr + cont_map[cont];
|
|
|
|
switch (pi->mode) {
|
|
case 0:
|
|
w0(r & 0xf); w0(r); t2(2); t2(4);
|
|
l = r1();
|
|
t2(4);
|
|
h = r1();
|
|
return j44(l, h);
|
|
case 1:
|
|
w0(r & 0xf); w0(r); t2(2);
|
|
e2(); t2(0x20);
|
|
t2(4); h = r0();
|
|
t2(1); t2(0x20);
|
|
return h;
|
|
case 2:
|
|
case 3:
|
|
case 4:
|
|
w0(r); w2(9); w2(0); w2(0x20);
|
|
h = r4();
|
|
w2(0);
|
|
return h;
|
|
|
|
}
|
|
return -1;
|
|
}
|
|
|
|
static void bpck_write_regr(struct pi_adapter *pi, int cont, int regr, int val)
|
|
{
|
|
int r;
|
|
|
|
r = regr + cont_map[cont];
|
|
|
|
switch (pi->mode) {
|
|
case 0:
|
|
case 1: w0(r);
|
|
t2(2);
|
|
w0(val);
|
|
o2(); t2(4); t2(1);
|
|
break;
|
|
case 2:
|
|
case 3:
|
|
case 4: w0(r); w2(9); w2(0);
|
|
w0(val); w2(1); w2(3); w2(0);
|
|
break;
|
|
|
|
}
|
|
}
|
|
|
|
/* These macros access the bpck registers in native addressing */
|
|
|
|
#define WR(r,v) bpck_write_regr(pi,2,r,v)
|
|
#define RR(r) (bpck_read_regr(pi,2,r))
|
|
|
|
static void bpck_write_block(struct pi_adapter *pi, char *buf, int count)
|
|
{
|
|
int i;
|
|
|
|
switch (pi->mode) {
|
|
|
|
case 0:
|
|
WR(4, 0x40);
|
|
w0(0x40); t2(2); t2(1);
|
|
for (i = 0; i < count; i++) {
|
|
w0(buf[i]);
|
|
t2(4);
|
|
}
|
|
WR(4, 0);
|
|
break;
|
|
|
|
case 1:
|
|
WR(4, 0x50);
|
|
w0(0x40); t2(2); t2(1);
|
|
for (i = 0; i < count; i++) {
|
|
w0(buf[i]);
|
|
t2(4);
|
|
}
|
|
WR(4, 0x10);
|
|
break;
|
|
|
|
case 2:
|
|
WR(4, 0x48);
|
|
w0(0x40); w2(9); w2(0); w2(1);
|
|
for (i = 0; i < count; i++)
|
|
w4(buf[i]);
|
|
w2(0);
|
|
WR(4, 8);
|
|
break;
|
|
|
|
case 3:
|
|
WR(4, 0x48);
|
|
w0(0x40); w2(9); w2(0); w2(1);
|
|
for (i = 0; i < count / 2; i++)
|
|
w4w(((u16 *)buf)[i]);
|
|
w2(0);
|
|
WR(4, 8);
|
|
break;
|
|
|
|
case 4:
|
|
WR(4, 0x48);
|
|
w0(0x40); w2(9); w2(0); w2(1);
|
|
for (i = 0; i < count / 4; i++)
|
|
w4l(((u32 *)buf)[i]);
|
|
w2(0);
|
|
WR(4, 8);
|
|
break;
|
|
}
|
|
}
|
|
|
|
static void bpck_read_block(struct pi_adapter *pi, char *buf, int count)
|
|
{
|
|
int i, l, h;
|
|
|
|
switch (pi->mode) {
|
|
|
|
case 0:
|
|
WR(4, 0x40);
|
|
w0(0x40); t2(2);
|
|
for (i = 0; i < count; i++) {
|
|
t2(4); l = r1();
|
|
t2(4); h = r1();
|
|
buf[i] = j44(l, h);
|
|
}
|
|
WR(4, 0);
|
|
break;
|
|
|
|
case 1:
|
|
WR(4, 0x50);
|
|
w0(0x40); t2(2); t2(0x20);
|
|
for (i = 0; i < count; i++) {
|
|
t2(4);
|
|
buf[i] = r0();
|
|
}
|
|
t2(1); t2(0x20);
|
|
WR(4, 0x10);
|
|
break;
|
|
|
|
case 2:
|
|
WR(4, 0x48);
|
|
w0(0x40); w2(9); w2(0); w2(0x20);
|
|
for (i = 0; i < count; i++)
|
|
buf[i] = r4();
|
|
w2(0);
|
|
WR(4, 8);
|
|
break;
|
|
|
|
case 3:
|
|
WR(4, 0x48);
|
|
w0(0x40); w2(9); w2(0); w2(0x20);
|
|
for (i = 0; i < count / 2; i++)
|
|
((u16 *)buf)[i] = r4w();
|
|
w2(0);
|
|
WR(4, 8);
|
|
break;
|
|
|
|
case 4:
|
|
WR(4, 0x48);
|
|
w0(0x40); w2(9); w2(0); w2(0x20);
|
|
for (i = 0; i < count / 4; i++)
|
|
((u32 *)buf)[i] = r4l();
|
|
w2(0);
|
|
WR(4, 8);
|
|
break;
|
|
|
|
}
|
|
}
|
|
|
|
static int bpck_probe_unit(struct pi_adapter *pi)
|
|
{
|
|
int o1, o0, f7, id;
|
|
int t, s;
|
|
|
|
id = pi->unit;
|
|
s = 0;
|
|
w2(4); w2(0xe); r2(); t2(2);
|
|
o1 = r1()&0xf8;
|
|
o0 = r0();
|
|
w0(255-id); w2(4); w0(id);
|
|
t2(8); t2(8); t2(8);
|
|
t2(2); t = r1()&0xf8;
|
|
f7 = ((id % 8) == 7);
|
|
if ((f7) || (t != o1)) {
|
|
t2(2);
|
|
s = r1() & 0xf8;
|
|
}
|
|
if ((t == o1) && ((!f7) || (s == o1))) {
|
|
w2(0x4c); w0(o0);
|
|
return 0;
|
|
}
|
|
t2(8); w0(0); t2(2); w2(0x4c); w0(o0);
|
|
return 1;
|
|
}
|
|
|
|
static void bpck_connect(struct pi_adapter *pi)
|
|
{
|
|
pi->saved_r0 = r0();
|
|
w0(0xff-pi->unit); w2(4); w0(pi->unit);
|
|
t2(8); t2(8); t2(8);
|
|
t2(2); t2(2);
|
|
|
|
switch (pi->mode) {
|
|
case 0:
|
|
t2(8); WR(4, 0);
|
|
break;
|
|
case 1:
|
|
t2(8); WR(4, 0x10);
|
|
break;
|
|
case 2:
|
|
case 3:
|
|
case 4:
|
|
w2(0); WR(4, 8);
|
|
break;
|
|
}
|
|
|
|
WR(5,8);
|
|
|
|
/*
|
|
* Possibly wrong, purpose unknown (fiddle with ESS logic ???)
|
|
* if (pi->devtype == PI_PCD) {
|
|
*/
|
|
WR(0x46, 0x10);
|
|
WR(0x4c, 0x38);
|
|
WR(0x4d, 0x88);
|
|
WR(0x46, 0xa0);
|
|
WR(0x41, 0);
|
|
WR(0x4e, 8);
|
|
/* } */
|
|
}
|
|
|
|
static void bpck_disconnect(struct pi_adapter *pi)
|
|
{
|
|
w0(0);
|
|
if (pi->mode >= 2) {
|
|
w2(9); w2(0);
|
|
} else {
|
|
t2(2);
|
|
}
|
|
w2(0x4c); w0(pi->saved_r0);
|
|
}
|
|
|
|
static void bpck_force_spp(struct pi_adapter *pi)
|
|
{
|
|
/* This fakes the EPP protocol to turn off EPP ... */
|
|
pi->saved_r0 = r0();
|
|
w0(0xff-pi->unit); w2(4); w0(pi->unit);
|
|
t2(8); t2(8); t2(8);
|
|
t2(2); t2(2);
|
|
|
|
w2(0);
|
|
w0(4); w2(9); w2(0);
|
|
w0(0); w2(1); w2(3); w2(0);
|
|
w0(0); w2(9); w2(0);
|
|
w2(0x4c); w0(pi->saved_r0);
|
|
}
|
|
|
|
#define TEST_LEN 16
|
|
|
|
static int bpck_test_proto(struct pi_adapter *pi)
|
|
{
|
|
int i, e, l, h, om;
|
|
char buf[TEST_LEN];
|
|
|
|
bpck_force_spp(pi);
|
|
|
|
switch (pi->mode) {
|
|
|
|
case 0:
|
|
bpck_connect(pi);
|
|
WR(0x13, 0x7f);
|
|
w0(0x13); t2(2);
|
|
for (i = 0; i < TEST_LEN; i++) {
|
|
t2(4); l = r1();
|
|
t2(4); h = r1();
|
|
buf[i] = j44(l, h);
|
|
}
|
|
bpck_disconnect(pi);
|
|
break;
|
|
|
|
case 1:
|
|
bpck_connect(pi);
|
|
WR(0x13, 0x7f);
|
|
w0(0x13); t2(2); t2(0x20);
|
|
for (i = 0; i < TEST_LEN; i++) {
|
|
t2(4);
|
|
buf[i] = r0();
|
|
}
|
|
t2(1); t2(0x20);
|
|
bpck_disconnect(pi);
|
|
break;
|
|
|
|
case 2:
|
|
case 3:
|
|
case 4:
|
|
om = pi->mode;
|
|
pi->mode = 0;
|
|
bpck_connect(pi);
|
|
WR(7, 3);
|
|
WR(4, 8);
|
|
bpck_disconnect(pi);
|
|
|
|
pi->mode = om;
|
|
bpck_connect(pi);
|
|
w0(0x13); w2(9); w2(1); w0(0); w2(3); w2(0); w2(0xe0);
|
|
|
|
switch (pi->mode) {
|
|
case 2:
|
|
for (i = 0; i < TEST_LEN; i++)
|
|
buf[i] = r4();
|
|
break;
|
|
case 3:
|
|
for (i = 0; i < TEST_LEN / 2; i++)
|
|
((u16 *)buf)[i] = r4w();
|
|
break;
|
|
case 4:
|
|
for (i = 0; i < TEST_LEN / 4; i++)
|
|
((u32 *)buf)[i] = r4l();
|
|
break;
|
|
}
|
|
|
|
w2(0);
|
|
WR(7, 0);
|
|
bpck_disconnect(pi);
|
|
break;
|
|
|
|
}
|
|
|
|
dev_dbg(&pi->dev, "bpck: 0x%x unit %d mode %d: ",
|
|
pi->port, pi->unit, pi->mode);
|
|
print_hex_dump_debug("bpck: ", DUMP_PREFIX_NONE, TEST_LEN, 1, buf,
|
|
TEST_LEN, false);
|
|
|
|
e = 0;
|
|
for (i = 0; i < TEST_LEN; i++) {
|
|
if (buf[i] != i + 1)
|
|
e++;
|
|
}
|
|
|
|
return e;
|
|
}
|
|
|
|
static void bpck_read_eeprom(struct pi_adapter *pi, char *buf)
|
|
{
|
|
int i, j, k, p, v, f, om, od;
|
|
|
|
bpck_force_spp(pi);
|
|
|
|
om = pi->mode; od = pi->delay;
|
|
pi->mode = 0; pi->delay = 6;
|
|
|
|
bpck_connect(pi);
|
|
|
|
WR(4, 0);
|
|
for (i = 0; i < 64; i++) {
|
|
WR(6, 8);
|
|
WR(6, 0xc);
|
|
p = 0x100;
|
|
for (k = 0; k < 9; k++) {
|
|
f = (((i + 0x180) & p) != 0) * 2;
|
|
WR(6, f + 0xc);
|
|
WR(6, f + 0xd);
|
|
WR(6, f + 0xc);
|
|
p = (p >> 1);
|
|
}
|
|
for (j = 0; j < 2; j++) {
|
|
v = 0;
|
|
for (k = 0; k < 8; k++) {
|
|
WR(6, 0xc);
|
|
WR(6, 0xd);
|
|
WR(6, 0xc);
|
|
f = RR(0);
|
|
v = 2 * v + (f == 0x84);
|
|
}
|
|
buf[2 * i + 1 - j] = v;
|
|
}
|
|
}
|
|
WR(6, 8);
|
|
WR(6, 0);
|
|
WR(5, 8);
|
|
|
|
bpck_disconnect(pi);
|
|
|
|
if (om >= 2) {
|
|
bpck_connect(pi);
|
|
WR(7, 3);
|
|
WR(4, 8);
|
|
bpck_disconnect(pi);
|
|
}
|
|
|
|
pi->mode = om; pi->delay = od;
|
|
}
|
|
|
|
static int bpck_test_port(struct pi_adapter *pi)
|
|
{
|
|
int i, r, m;
|
|
|
|
/* Check for 8-bit port */
|
|
w2(0x2c); i = r0(); w0(255-i); r = r0(); w0(i);
|
|
m = -1;
|
|
if (r == i)
|
|
m = 2;
|
|
if (r == (255-i))
|
|
m = 0;
|
|
|
|
w2(0xc);
|
|
i = r0();
|
|
w0(255-i);
|
|
r = r0();
|
|
w0(i);
|
|
if (r != (255-i))
|
|
m = -1;
|
|
|
|
if (m == 0) {
|
|
w2(6);
|
|
w2(0xc);
|
|
r = r0();
|
|
w0(0xaa);
|
|
w0(r);
|
|
w0(0xaa);
|
|
}
|
|
if (m == 2) {
|
|
w2(0x26);
|
|
w2(0xc);
|
|
}
|
|
|
|
if (m == -1)
|
|
return 0;
|
|
|
|
return 5;
|
|
}
|
|
|
|
static void bpck_log_adapter(struct pi_adapter *pi)
|
|
{
|
|
char *mode_str[5] = { "4-bit", "8-bit", "EPP-8", "EPP-16", "EPP-32" };
|
|
char scratch[128];
|
|
|
|
bpck_read_eeprom(pi,scratch);
|
|
print_hex_dump_bytes("bpck EEPROM: ", DUMP_PREFIX_NONE, scratch, 128);
|
|
dev_info(&pi->dev,
|
|
"backpack %8.8s unit %d at 0x%x, mode %d (%s), delay %d\n",
|
|
&scratch[110], pi->unit, pi->port, pi->mode,
|
|
mode_str[pi->mode], pi->delay);
|
|
}
|
|
|
|
static struct pi_protocol bpck = {
|
|
.owner = THIS_MODULE,
|
|
.name = "bpck",
|
|
.max_mode = 5,
|
|
.epp_first = 2,
|
|
.default_delay = 4,
|
|
.max_units = 255,
|
|
.write_regr = bpck_write_regr,
|
|
.read_regr = bpck_read_regr,
|
|
.write_block = bpck_write_block,
|
|
.read_block = bpck_read_block,
|
|
.connect = bpck_connect,
|
|
.disconnect = bpck_disconnect,
|
|
.test_port = bpck_test_port,
|
|
.probe_unit = bpck_probe_unit,
|
|
.test_proto = bpck_test_proto,
|
|
.log_adapter = bpck_log_adapter,
|
|
};
|
|
|
|
MODULE_LICENSE("GPL");
|
|
module_pata_parport_driver(bpck);
|