Skip to content

Commit 5741973

Browse files
Ondrej ZaryDamien Le Moal
authored andcommitted
ata: pata_parport-bpck6: move ppc6_rd_data_byte to bpck6.c and rename
Move ppc6_rd_data_byte to bpck6.c and rename it to bpck6_rd_data_byte Signed-off-by: Ondrej Zary <[email protected]> Signed-off-by: Damien Le Moal <[email protected]>
1 parent b040627 commit 5741973

File tree

2 files changed

+36
-63
lines changed

2 files changed

+36
-63
lines changed

drivers/ata/pata_parport/bpck6.c

Lines changed: 36 additions & 2 deletions
Original file line numberDiff line numberDiff line change
@@ -37,12 +37,46 @@ static void bpck6_send_cmd(struct pi_adapter *pi, u8 cmd)
3737
}
3838
}
3939

40+
static u8 bpck6_rd_data_byte(struct pi_adapter *pi)
41+
{
42+
u8 data = 0;
43+
44+
switch (mode_map[pi->mode]) {
45+
case PPCMODE_UNI_SW:
46+
case PPCMODE_UNI_FW:
47+
parport_frob_control(pi->pardev->port, PARPORT_CONTROL_STROBE,
48+
PARPORT_CONTROL_INIT);
49+
data = parport_read_status(pi->pardev->port);
50+
data = ((data & 0x80) >> 1) | ((data & 0x38) >> 3);
51+
parport_frob_control(pi->pardev->port, PARPORT_CONTROL_STROBE,
52+
PARPORT_CONTROL_STROBE);
53+
data |= parport_read_status(pi->pardev->port) & 0xB8;
54+
break;
55+
case PPCMODE_BI_SW:
56+
case PPCMODE_BI_FW:
57+
parport_data_reverse(pi->pardev->port);
58+
parport_frob_control(pi->pardev->port, PARPORT_CONTROL_STROBE,
59+
PARPORT_CONTROL_STROBE | PARPORT_CONTROL_INIT);
60+
data = parport_read_data(pi->pardev->port);
61+
parport_frob_control(pi->pardev->port, PARPORT_CONTROL_STROBE, 0);
62+
parport_data_forward(pi->pardev->port);
63+
break;
64+
case PPCMODE_EPP_BYTE:
65+
case PPCMODE_EPP_WORD:
66+
case PPCMODE_EPP_DWORD:
67+
pi->pardev->port->ops->epp_read_data(pi->pardev->port, &data, 1, 0);
68+
break;
69+
}
70+
71+
return data;
72+
}
73+
4074
static int bpck6_read_regr(struct pi_adapter *pi, int cont, int reg)
4175
{
4276
u8 port = cont ? reg | 8 : reg;
4377

4478
bpck6_send_cmd(pi, port | ACCESS_PORT | ACCESS_READ);
45-
return ppc6_rd_data_byte(pi);
79+
return bpck6_rd_data_byte(pi);
4680
}
4781

4882
static void bpck6_write_regr(struct pi_adapter *pi, int cont, int reg, int val)
@@ -240,7 +274,7 @@ static int bpck6_open(struct pi_adapter *pi)
240274
ppc6_wr_data_byte(pi, RAMSIZE_128K);
241275

242276
bpck6_send_cmd(pi, ACCESS_REG | ACCESS_READ | REG_VERSION);
243-
if ((ppc6_rd_data_byte(pi) & 0x3F) == 0x0C)
277+
if ((bpck6_rd_data_byte(pi) & 0x3F) == 0x0C)
244278
pi->private |= fifo_wait;
245279

246280
return 1;

drivers/ata/pata_parport/ppc6lnx.c

Lines changed: 0 additions & 61 deletions
Original file line numberDiff line numberDiff line change
@@ -68,7 +68,6 @@
6868
//***************************************************************************
6969

7070
static void ppc6_wr_data_byte(struct pi_adapter *pi, u8 data);
71-
static u8 ppc6_rd_data_byte(struct pi_adapter *pi);
7271

7372
//***************************************************************************
7473

@@ -102,63 +101,3 @@ static void ppc6_wr_data_byte(struct pi_adapter *pi, u8 data)
102101
}
103102
}
104103
}
105-
106-
//***************************************************************************
107-
108-
static u8 ppc6_rd_data_byte(struct pi_adapter *pi)
109-
{
110-
u8 data = 0;
111-
112-
switch (mode_map[pi->mode])
113-
{
114-
case PPCMODE_UNI_SW :
115-
case PPCMODE_UNI_FW :
116-
{
117-
parport_frob_control(pi->pardev->port,
118-
PARPORT_CONTROL_STROBE, PARPORT_CONTROL_INIT);
119-
120-
// DELAY
121-
122-
data = parport_read_status(pi->pardev->port);
123-
124-
data = ((data & 0x80) >> 1) | ((data & 0x38) >> 3);
125-
126-
parport_frob_control(pi->pardev->port,
127-
PARPORT_CONTROL_STROBE, PARPORT_CONTROL_STROBE);
128-
129-
// DELAY
130-
131-
data |= parport_read_status(pi->pardev->port) & 0xB8;
132-
133-
break;
134-
}
135-
136-
case PPCMODE_BI_SW :
137-
case PPCMODE_BI_FW :
138-
{
139-
parport_data_reverse(pi->pardev->port);
140-
141-
parport_frob_control(pi->pardev->port, PARPORT_CONTROL_STROBE,
142-
PARPORT_CONTROL_STROBE | PARPORT_CONTROL_INIT);
143-
144-
data = parport_read_data(pi->pardev->port);
145-
146-
parport_frob_control(pi->pardev->port, PARPORT_CONTROL_STROBE, 0);
147-
148-
parport_data_forward(pi->pardev->port);
149-
150-
break;
151-
}
152-
153-
case PPCMODE_EPP_BYTE :
154-
case PPCMODE_EPP_WORD :
155-
case PPCMODE_EPP_DWORD :
156-
{
157-
pi->pardev->port->ops->epp_read_data(pi->pardev->port, &data, 1, 0);
158-
159-
break;
160-
}
161-
}
162-
163-
return(data);
164-
}

0 commit comments

Comments
 (0)