[linux-2.6-block.git] / drivers / ide / arm / rapide.c

/*
 * Copyright (c) 1996-2002 Russell King.
 */

#include <linux/module.h>
#include <linux/slab.h>
#include <linux/blkdev.h>
#include <linux/errno.h>
#include <linux/ide.h>
#include <linux/init.h>

#include <asm/ecard.h>

static struct const ide_port_info rapide_port_info = {
	.host_flags		= IDE_HFLAG_MMIO | IDE_HFLAG_NO_DMA,
};

static void rapide_setup_ports(hw_regs_t *hw, void __iomem *base,
			       void __iomem *ctrl, unsigned int sz, int irq)
{
	unsigned long port = (unsigned long)base;
	int i;

	for (i = 0; i <= 7; i++) {
		hw->io_ports_array[i] = port;
		port += sz;
	}
	hw->io_ports.ctl_addr = (unsigned long)ctrl;
	hw->irq = irq;
}

static int __devinit
rapide_probe(struct expansion_card *ec, const struct ecard_id *id)
{
	ide_hwif_t *hwif;
	void __iomem *base;
	int ret;
	hw_regs_t hw, *hws[] = { &hw, NULL, NULL, NULL };
	u8 idx[4] = { 0xff, 0xff, 0xff, 0xff };

	ret = ecard_request_resources(ec);
	if (ret)
		goto out;

	base = ecardm_iomap(ec, ECARD_RES_MEMC, 0, 0);
	if (!base) {
		ret = -ENOMEM;
		goto release;
	}

	memset(&hw, 0, sizeof(hw));
	rapide_setup_ports(&hw, base, base + 0x818, 1 << 6, ec->irq);
	hw.chipset = ide_generic;
	hw.dev = &ec->dev;

	hwif = ide_find_port();
	if (hwif == NULL) {
		ret = -ENOENT;
		goto release;
	}

	idx[0] = hwif->index;

	ide_device_add(idx, &rapide_port_info, hws);

	ecard_set_drvdata(ec, hwif);
	goto out;

 release:
	ecard_release_resources(ec);
 out:
	return ret;
}

static void __devexit rapide_remove(struct expansion_card *ec)
{
	ide_hwif_t *hwif = ecard_get_drvdata(ec);

	ecard_set_drvdata(ec, NULL);

	ide_unregister(hwif);

	ecard_release_resources(ec);
}

static struct ecard_id rapide_ids[] = {
	{ MANU_YELLOWSTONE, PROD_YELLOWSTONE_RAPIDE32 },
	{ 0xffff, 0xffff }
};

static struct ecard_driver rapide_driver = {
	.probe		= rapide_probe,
	.remove		= __devexit_p(rapide_remove),
	.id_table	= rapide_ids,
	.drv = {
		.name	= "rapide",
	},
};

static int __init rapide_init(void)
{
	return ecard_register_driver(&rapide_driver);
}

MODULE_LICENSE("GPL");
MODULE_DESCRIPTION("Yellowstone RAPIDE driver");

module_init(rapide_init);
Commit	Line	Data
1da177e4	1	/*
1da177e4 LT	2	* Copyright (c) 1996-2002 Russell King.
	3	*/
	4
	5	#include <linux/module.h>
	6	#include <linux/slab.h>
	7	#include <linux/blkdev.h>
	8	#include <linux/errno.h>
	9	#include <linux/ide.h>
	10	#include <linux/init.h>
	11
	12	#include <asm/ecard.h>
	13
9a5ae1fa BZ	14	static struct const ide_port_info rapide_port_info = {
	15	.host_flags = IDE_HFLAG_MMIO \| IDE_HFLAG_NO_DMA,
	16	};
	17
57c802e8 BZ	18	static void rapide_setup_ports(hw_regs_t hw, void __iomem base,
57c802e8 BZ	19	void __iomem *ctrl, unsigned int sz, int irq)
1da177e4 LT	20	{
1da177e4 LT	21	unsigned long port = (unsigned long)base;
baa8f3e9	22	int i;
1da177e4	23
4c3032d8 BZ	24	for (i = 0; i <= 7; i++) {
4c3032d8 BZ	25	hw->io_ports_array[i] = port;
1da177e4 LT	26	port += sz;
1da177e4 LT	27	}
4c3032d8	28	hw->io_ports.ctl_addr = (unsigned long)ctrl;
57c802e8	29	hw->irq = irq;
1da177e4 LT	30	}
	31
	32	static int __devinit
	33	rapide_probe(struct expansion_card ec, const struct ecard_id id)
	34	{
	35	ide_hwif_t *hwif;
	36	void __iomem *base;
	37	int ret;
c97c6aca	38	hw_regs_t hw, *hws[] = { &hw, NULL, NULL, NULL };
8447d9d5	39	u8 idx[4] = { 0xff, 0xff, 0xff, 0xff };
1da177e4 LT	40
	41	ret = ecard_request_resources(ec);
	42	if (ret)
	43	goto out;
	44
10bdaaa0	45	base = ecardm_iomap(ec, ECARD_RES_MEMC, 0, 0);
1da177e4 LT	46	if (!base) {
	47	ret = -ENOMEM;
	48	goto release;
	49	}
	50
47bc7e74 BZ	51	memset(&hw, 0, sizeof(hw));
	52	rapide_setup_ports(&hw, base, base + 0x818, 1 << 6, ec->irq);
	53	hw.chipset = ide_generic;
	54	hw.dev = &ec->dev;
57c802e8	55
47bc7e74 BZ	56	hwif = ide_find_port();
	57	if (hwif == NULL) {
	58	ret = -ENOENT;
	59	goto release;
	60	}
57c802e8	61
47bc7e74	62	idx[0] = hwif->index;
8447d9d5	63
c97c6aca	64	ide_device_add(idx, &rapide_port_info, hws);
8447d9d5	65
47bc7e74 BZ	66	ecard_set_drvdata(ec, hwif);
47bc7e74 BZ	67	goto out;
1da177e4	68
1da177e4 LT	69	release:
	70	ecard_release_resources(ec);
	71	out:
	72	return ret;
	73	}
	74
	75	static void __devexit rapide_remove(struct expansion_card *ec)
	76	{
	77	ide_hwif_t *hwif = ecard_get_drvdata(ec);
	78
	79	ecard_set_drvdata(ec, NULL);
	80
387750c3	81	ide_unregister(hwif);
fadd11c7	82
1da177e4 LT	83	ecard_release_resources(ec);
	84	}
	85
	86	static struct ecard_id rapide_ids[] = {
	87	{ MANU_YELLOWSTONE, PROD_YELLOWSTONE_RAPIDE32 },
	88	{ 0xffff, 0xffff }
	89	};
	90
	91	static struct ecard_driver rapide_driver = {
	92	.probe = rapide_probe,
	93	.remove = __devexit_p(rapide_remove),
	94	.id_table = rapide_ids,
	95	.drv = {
	96	.name = "rapide",
	97	},
	98	};
	99
	100	static int __init rapide_init(void)
	101	{
	102	return ecard_register_driver(&rapide_driver);
	103	}
	104
	105	MODULE_LICENSE("GPL");
	106	MODULE_DESCRIPTION("Yellowstone RAPIDE driver");
	107
	108	module_init(rapide_init);