mirror of
https://git.kernel.org/pub/scm/linux/kernel/git/stable/linux.git
synced 2024-10-02 23:27:06 +00:00
ata: pata_parport-bpck6: merge ppc6_wr_data_blk into bpck6_write_block
ppc6_wr_data_blk is only called by bpck6_write_block. Merge ppc6_wr_data_blk into bpck6_write_block. Signed-off-by: Ondrej Zary <linux@zary.sk> Signed-off-by: Damien Le Moal <damien.lemoal@opensource.wdc.com>
This commit is contained in:
parent
db24d74324
commit
99c40a70dd
2 changed files with 57 additions and 92 deletions
|
@ -37,6 +37,8 @@ static void bpck6_write_regr(struct pi_adapter *pi, int cont, int reg, int val)
|
|||
|
||||
static void bpck6_write_block(struct pi_adapter *pi, char *buf, int len)
|
||||
{
|
||||
u8 this, last;
|
||||
|
||||
ppc6_send_cmd(pi, REG_BLKSIZE | ACCESS_REG | ACCESS_WRITE);
|
||||
ppc6_wr_data_byte(pi, (u8)len);
|
||||
ppc6_wr_data_byte(pi, (u8)(len >> 8));
|
||||
|
@ -44,7 +46,61 @@ static void bpck6_write_block(struct pi_adapter *pi, char *buf, int len)
|
|||
|
||||
ppc6_send_cmd(pi, CMD_PREFIX_SET | PREFIX_IO16 | PREFIX_BLK);
|
||||
ppc6_send_cmd(pi, ATA_REG_DATA | ACCESS_PORT | ACCESS_WRITE);
|
||||
ppc6_wr_data_blk(pi, buf, len);
|
||||
|
||||
switch (mode_map[pi->mode]) {
|
||||
case PPCMODE_UNI_SW:
|
||||
case PPCMODE_BI_SW:
|
||||
while (len--) {
|
||||
parport_write_data(pi->pardev->port, *buf++);
|
||||
parport_frob_control(pi->pardev->port, 0,
|
||||
PARPORT_CONTROL_INIT);
|
||||
}
|
||||
break;
|
||||
case PPCMODE_UNI_FW:
|
||||
case PPCMODE_BI_FW:
|
||||
ppc6_send_cmd(pi, CMD_PREFIX_SET | PREFIX_FASTWR);
|
||||
|
||||
parport_frob_control(pi->pardev->port, PARPORT_CONTROL_STROBE,
|
||||
PARPORT_CONTROL_STROBE);
|
||||
|
||||
last = *buf;
|
||||
|
||||
parport_write_data(pi->pardev->port, last);
|
||||
|
||||
while (len) {
|
||||
this = *buf++;
|
||||
len--;
|
||||
|
||||
if (this == last) {
|
||||
parport_frob_control(pi->pardev->port, 0,
|
||||
PARPORT_CONTROL_INIT);
|
||||
} else {
|
||||
parport_write_data(pi->pardev->port, this);
|
||||
last = this;
|
||||
}
|
||||
}
|
||||
|
||||
parport_frob_control(pi->pardev->port, PARPORT_CONTROL_STROBE,
|
||||
0);
|
||||
ppc6_send_cmd(pi, CMD_PREFIX_RESET | PREFIX_FASTWR);
|
||||
break;
|
||||
case PPCMODE_EPP_BYTE:
|
||||
pi->pardev->port->ops->epp_write_data(pi->pardev->port, buf,
|
||||
len, PARPORT_EPP_FAST_8);
|
||||
ppc6_wait_for_fifo(pi);
|
||||
break;
|
||||
case PPCMODE_EPP_WORD:
|
||||
pi->pardev->port->ops->epp_write_data(pi->pardev->port, buf,
|
||||
len, PARPORT_EPP_FAST_16);
|
||||
ppc6_wait_for_fifo(pi);
|
||||
break;
|
||||
case PPCMODE_EPP_DWORD:
|
||||
pi->pardev->port->ops->epp_write_data(pi->pardev->port, buf,
|
||||
len, PARPORT_EPP_FAST_32);
|
||||
ppc6_wait_for_fifo(pi);
|
||||
break;
|
||||
}
|
||||
|
||||
ppc6_send_cmd(pi, CMD_PREFIX_RESET | PREFIX_IO16 | PREFIX_BLK);
|
||||
}
|
||||
|
||||
|
|
|
@ -73,7 +73,6 @@ static void ppc6_send_cmd(struct pi_adapter *pi, u8 cmd);
|
|||
static void ppc6_wr_data_byte(struct pi_adapter *pi, u8 data);
|
||||
static u8 ppc6_rd_data_byte(struct pi_adapter *pi);
|
||||
static void ppc6_wait_for_fifo(struct pi_adapter *pi);
|
||||
static void ppc6_wr_data_blk(struct pi_adapter *pi, u8 *data, long count);
|
||||
static void ppc6_wr_extout(struct pi_adapter *pi, u8 regdata);
|
||||
static int ppc6_open(struct pi_adapter *pi);
|
||||
|
||||
|
@ -296,96 +295,6 @@ static void ppc6_wait_for_fifo(struct pi_adapter *pi)
|
|||
|
||||
//***************************************************************************
|
||||
|
||||
static void ppc6_wr_data_blk(struct pi_adapter *pi, u8 *data, long count)
|
||||
{
|
||||
switch (mode_map[pi->mode])
|
||||
{
|
||||
case PPCMODE_UNI_SW :
|
||||
case PPCMODE_BI_SW :
|
||||
{
|
||||
while(count--)
|
||||
{
|
||||
parport_write_data(pi->pardev->port, *data++);
|
||||
|
||||
parport_frob_control(pi->pardev->port, 0, PARPORT_CONTROL_INIT);
|
||||
}
|
||||
|
||||
break;
|
||||
}
|
||||
|
||||
case PPCMODE_UNI_FW :
|
||||
case PPCMODE_BI_FW :
|
||||
{
|
||||
u8 this, last;
|
||||
|
||||
ppc6_send_cmd(pi, CMD_PREFIX_SET | PREFIX_FASTWR);
|
||||
|
||||
parport_frob_control(pi->pardev->port,
|
||||
PARPORT_CONTROL_STROBE, PARPORT_CONTROL_STROBE);
|
||||
|
||||
last = *data;
|
||||
|
||||
parport_write_data(pi->pardev->port, last);
|
||||
|
||||
while(count)
|
||||
{
|
||||
this = *data++;
|
||||
count--;
|
||||
|
||||
if (this == last)
|
||||
{
|
||||
parport_frob_control(pi->pardev->port,
|
||||
0, PARPORT_CONTROL_INIT);
|
||||
}
|
||||
else
|
||||
{
|
||||
parport_write_data(pi->pardev->port, this);
|
||||
|
||||
last = this;
|
||||
}
|
||||
}
|
||||
|
||||
parport_frob_control(pi->pardev->port, PARPORT_CONTROL_STROBE, 0);
|
||||
|
||||
ppc6_send_cmd(pi, CMD_PREFIX_RESET | PREFIX_FASTWR);
|
||||
|
||||
break;
|
||||
}
|
||||
|
||||
case PPCMODE_EPP_BYTE :
|
||||
{
|
||||
pi->pardev->port->ops->epp_write_data(pi->pardev->port,
|
||||
data, count, PARPORT_EPP_FAST_8);
|
||||
|
||||
ppc6_wait_for_fifo(pi);
|
||||
|
||||
break;
|
||||
}
|
||||
|
||||
case PPCMODE_EPP_WORD :
|
||||
{
|
||||
pi->pardev->port->ops->epp_write_data(pi->pardev->port,
|
||||
data, count, PARPORT_EPP_FAST_16);
|
||||
|
||||
ppc6_wait_for_fifo(pi);
|
||||
|
||||
break;
|
||||
}
|
||||
|
||||
case PPCMODE_EPP_DWORD :
|
||||
{
|
||||
pi->pardev->port->ops->epp_write_data(pi->pardev->port,
|
||||
data, count, PARPORT_EPP_FAST_32);
|
||||
|
||||
ppc6_wait_for_fifo(pi);
|
||||
|
||||
break;
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
//***************************************************************************
|
||||
|
||||
static void ppc6_wr_extout(struct pi_adapter *pi, u8 regdata)
|
||||
{
|
||||
ppc6_send_cmd(pi, REG_VERSION | ACCESS_REG | ACCESS_WRITE);
|
||||
|
|
Loading…
Reference in a new issue