Donate to e Foundation | Murena handsets with /e/OS | Own a part of Murena! Learn more

Commit b25afdf1 authored by Bartlomiej Zolnierkiewicz's avatar Bartlomiej Zolnierkiewicz
Browse files

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
Loading
Loading
Loading
Loading
+38 −34
Original line number Diff line number Diff line
@@ -415,36 +415,24 @@ static int icside_dma_off_init(ide_hwif_t *hwif, const struct ide_port_info *d)
	return -EOPNOTSUPP;
}

static ide_hwif_t *
icside_setup(void __iomem *base, struct cardinfo *info, struct expansion_card *ec)
static void icside_setup_ports(hw_regs_t *hw, void __iomem *base,
			       struct cardinfo *info, struct expansion_card *ec)
{
	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);
	hw->io_ports.data_addr	 = port;
	hw->io_ports.error_addr	 = port + (1 << info->stepping);
	hw->io_ports.nsect_addr	 = port + (2 << info->stepping);
	hw->io_ports.lbal_addr	 = port + (3 << info->stepping);
	hw->io_ports.lbam_addr	 = port + (4 << info->stepping);
	hw->io_ports.lbah_addr	 = port + (5 << info->stepping);
	hw->io_ports.device_addr = port + (6 << info->stepping);
	hw->io_ports.status_addr = port + (7 << info->stepping);
	hw->io_ports.ctl_addr	 = (unsigned long)base + info->ctrloffset;

		hwif->io_ports.data_addr = port;
		hwif->io_ports.error_addr = port + (1 << info->stepping);
		hwif->io_ports.nsect_addr = port + (2 << info->stepping);
		hwif->io_ports.lbal_addr = port + (3 << info->stepping);
		hwif->io_ports.lbam_addr = port + (4 << info->stepping);
		hwif->io_ports.lbah_addr = port + (5 << info->stepping);
		hwif->io_ports.device_addr = port + (6 << info->stepping);
		hwif->io_ports.status_addr = port + (7 << info->stepping);
		hwif->io_ports.ctl_addr =
			(unsigned long)base + info->ctrloffset;
		hwif->irq     = ec->irq;
		hwif->chipset = ide_acorn;
		hwif->gendev.parent = &ec->dev;
		hwif->dev = &ec->dev;
	}

	return hwif;
	hw->irq = ec->irq;
	hw->dev = &ec->dev;
	hw->chipset = ide_acorn;
}

static int __init
@@ -453,6 +441,7 @@ icside_register_v5(struct icside_state *state, struct expansion_card *ec)
	ide_hwif_t *hwif;
	void __iomem *base;
	u8 idx[4] = { 0xff, 0xff, 0xff, 0xff };
	hw_regs_t hw;

	base = ecardm_iomap(ec, ECARD_RES_MEMC, 0, 0);
	if (!base)
@@ -470,10 +459,15 @@ icside_register_v5(struct icside_state *state, struct expansion_card *ec)
	 */
	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)
		return -ENODEV;

	ide_init_port_hw(hwif, &hw);
	default_hwif_mmiops(hwif);

	state->hwif[0] = hwif;

	ecard_set_drvdata(ec, state);
@@ -503,6 +497,7 @@ icside_register_v6(struct icside_state *state, struct expansion_card *ec)
	int ret;
	u8 idx[4] = { 0xff, 0xff, 0xff, 0xff };
	struct ide_port_info d = icside_v6_port_info;
	hw_regs_t hw[2];

	ioc_base = ecardm_iomap(ec, ECARD_RES_IOCFAST, 0, 0);
	if (!ioc_base) {
@@ -538,16 +533,25 @@ icside_register_v6(struct icside_state *state, struct expansion_card *ec)
	 */
	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.
	 */
	hwif = icside_setup(easi_base, &icside_cardinfo_v6_1, ec);
	mate = icside_setup(easi_base, &icside_cardinfo_v6_2, ec);
	hwif = ide_find_port();
	if (hwif == NULL)
		return -ENODEV;

	if (!hwif || !mate) {
		ret = -ENODEV;
		goto out;
	}
	ide_init_port_hw(hwif, &hw[0]);
	default_hwif_mmiops(hwif);

	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[1]    = mate;