icside: use ide_init_port_hw()

* Move ide_find_port() and default_hwif_mmiops() calls from icside_setup()
  to icside_register_v{5,6}().

* Convert icside_setup() to initialize hw_regs_t instead ide_hwif_t
  and icside_register_v{5,6}() to use ide_init_port_hw().

* Rename icside_setup() to icside_setup_ports().

There should be no functional changes caused by this patch.

Cc: Russell King <rmk@arm.linux.org.uk>
Signed-off-by: default avatarBartlomiej Zolnierkiewicz <bzolnier@gmail.com>
parent 26839f09
...@@ -415,36 +415,24 @@ static int icside_dma_off_init(ide_hwif_t *hwif, const struct ide_port_info *d) ...@@ -415,36 +415,24 @@ static int icside_dma_off_init(ide_hwif_t *hwif, const struct ide_port_info *d)
return -EOPNOTSUPP; return -EOPNOTSUPP;
} }
static ide_hwif_t * static void icside_setup_ports(hw_regs_t *hw, void __iomem *base,
icside_setup(void __iomem *base, struct cardinfo *info, struct expansion_card *ec) struct cardinfo *info, struct expansion_card *ec)
{ {
unsigned long port = (unsigned long)base + info->dataoffset; unsigned long port = (unsigned long)base + info->dataoffset;
ide_hwif_t *hwif;
hwif = ide_find_port();
if (hwif) {
/*
* Ensure we're using MMIO
*/
default_hwif_mmiops(hwif);
hwif->io_ports.data_addr = port; hw->io_ports.data_addr = port;
hwif->io_ports.error_addr = port + (1 << info->stepping); hw->io_ports.error_addr = port + (1 << info->stepping);
hwif->io_ports.nsect_addr = port + (2 << info->stepping); hw->io_ports.nsect_addr = port + (2 << info->stepping);
hwif->io_ports.lbal_addr = port + (3 << info->stepping); hw->io_ports.lbal_addr = port + (3 << info->stepping);
hwif->io_ports.lbam_addr = port + (4 << info->stepping); hw->io_ports.lbam_addr = port + (4 << info->stepping);
hwif->io_ports.lbah_addr = port + (5 << info->stepping); hw->io_ports.lbah_addr = port + (5 << info->stepping);
hwif->io_ports.device_addr = port + (6 << info->stepping); hw->io_ports.device_addr = port + (6 << info->stepping);
hwif->io_ports.status_addr = port + (7 << info->stepping); hw->io_ports.status_addr = port + (7 << info->stepping);
hwif->io_ports.ctl_addr = hw->io_ports.ctl_addr = (unsigned long)base + info->ctrloffset;
(unsigned long)base + info->ctrloffset;
hwif->irq = ec->irq; hw->irq = ec->irq;
hwif->chipset = ide_acorn; hw->dev = &ec->dev;
hwif->gendev.parent = &ec->dev; hw->chipset = ide_acorn;
hwif->dev = &ec->dev;
}
return hwif;
} }
static int __init static int __init
...@@ -453,6 +441,7 @@ icside_register_v5(struct icside_state *state, struct expansion_card *ec) ...@@ -453,6 +441,7 @@ icside_register_v5(struct icside_state *state, struct expansion_card *ec)
ide_hwif_t *hwif; ide_hwif_t *hwif;
void __iomem *base; void __iomem *base;
u8 idx[4] = { 0xff, 0xff, 0xff, 0xff }; u8 idx[4] = { 0xff, 0xff, 0xff, 0xff };
hw_regs_t hw;
base = ecardm_iomap(ec, ECARD_RES_MEMC, 0, 0); base = ecardm_iomap(ec, ECARD_RES_MEMC, 0, 0);
if (!base) if (!base)
...@@ -470,10 +459,15 @@ icside_register_v5(struct icside_state *state, struct expansion_card *ec) ...@@ -470,10 +459,15 @@ icside_register_v5(struct icside_state *state, struct expansion_card *ec)
*/ */
icside_irqdisable_arcin_v5(ec, 0); icside_irqdisable_arcin_v5(ec, 0);
hwif = icside_setup(base, &icside_cardinfo_v5, ec); icside_setup_ports(&hw, base, &icside_cardinfo_v5, ec);
hwif = ide_find_port();
if (!hwif) if (!hwif)
return -ENODEV; return -ENODEV;
ide_init_port_hw(hwif, &hw);
default_hwif_mmiops(hwif);
state->hwif[0] = hwif; state->hwif[0] = hwif;
ecard_set_drvdata(ec, state); ecard_set_drvdata(ec, state);
...@@ -503,6 +497,7 @@ icside_register_v6(struct icside_state *state, struct expansion_card *ec) ...@@ -503,6 +497,7 @@ icside_register_v6(struct icside_state *state, struct expansion_card *ec)
int ret; int ret;
u8 idx[4] = { 0xff, 0xff, 0xff, 0xff }; u8 idx[4] = { 0xff, 0xff, 0xff, 0xff };
struct ide_port_info d = icside_v6_port_info; struct ide_port_info d = icside_v6_port_info;
hw_regs_t hw[2];
ioc_base = ecardm_iomap(ec, ECARD_RES_IOCFAST, 0, 0); ioc_base = ecardm_iomap(ec, ECARD_RES_IOCFAST, 0, 0);
if (!ioc_base) { if (!ioc_base) {
...@@ -538,16 +533,25 @@ icside_register_v6(struct icside_state *state, struct expansion_card *ec) ...@@ -538,16 +533,25 @@ icside_register_v6(struct icside_state *state, struct expansion_card *ec)
*/ */
icside_irqdisable_arcin_v6(ec, 0); icside_irqdisable_arcin_v6(ec, 0);
icside_setup_ports(&hw[0], easi_base, &icside_cardinfo_v6_1, ec);
icside_setup_ports(&hw[1], easi_base, &icside_cardinfo_v6_2, ec);
/* /*
* Find and register the interfaces. * Find and register the interfaces.
*/ */
hwif = icside_setup(easi_base, &icside_cardinfo_v6_1, ec); hwif = ide_find_port();
mate = icside_setup(easi_base, &icside_cardinfo_v6_2, ec); if (hwif == NULL)
return -ENODEV;
if (!hwif || !mate) { ide_init_port_hw(hwif, &hw[0]);
ret = -ENODEV; default_hwif_mmiops(hwif);
goto out;
} mate = ide_find_port();
if (mate == NULL)
return -ENODEV;
ide_init_port_hw(mate, &hw[1]);
default_hwif_mmiops(mate);
state->hwif[0] = hwif; state->hwif[0] = hwif;
state->hwif[1] = mate; state->hwif[1] = mate;
......
Markdown is supported
0%
or
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment