Linux kernel mirror (for testing)
git.kernel.org/pub/scm/linux/kernel/git/torvalds/linux.git
tjh.dev
kernel
os
linux
1/*
2 * linux/drivers/ide/arm/rapide.c
3 *
4 * Copyright (c) 1996-2002 Russell King.
5 */
6
7#include <linux/module.h>
8#include <linux/slab.h>
9#include <linux/blkdev.h>
10#include <linux/errno.h>
11#include <linux/ide.h>
12#include <linux/init.h>
13
14#include <asm/ecard.h>
15
16static ide_hwif_t *
17rapide_locate_hwif(void __iomem *base, void __iomem *ctrl, unsigned int sz, int irq)
18{
19 unsigned long port = (unsigned long)base;
20 ide_hwif_t *hwif = ide_find_port(port);
21 int i;
22
23 if (hwif == NULL)
24 goto out;
25
26 for (i = IDE_DATA_OFFSET; i <= IDE_STATUS_OFFSET; i++) {
27 hwif->io_ports[i] = port;
28 port += sz;
29 }
30 hwif->io_ports[IDE_CONTROL_OFFSET] = (unsigned long)ctrl;
31 hwif->irq = irq;
32 hwif->mmio = 1;
33 default_hwif_mmiops(hwif);
34out:
35 return hwif;
36}
37
38static int __devinit
39rapide_probe(struct expansion_card *ec, const struct ecard_id *id)
40{
41 ide_hwif_t *hwif;
42 void __iomem *base;
43 int ret;
44 u8 idx[4] = { 0xff, 0xff, 0xff, 0xff };
45
46 ret = ecard_request_resources(ec);
47 if (ret)
48 goto out;
49
50 base = ecardm_iomap(ec, ECARD_RES_MEMC, 0, 0);
51 if (!base) {
52 ret = -ENOMEM;
53 goto release;
54 }
55
56 hwif = rapide_locate_hwif(base, base + 0x818, 1 << 6, ec->irq);
57 if (hwif) {
58 hwif->hwif_data = base;
59 hwif->gendev.parent = &ec->dev;
60 hwif->noprobe = 0;
61
62 idx[0] = hwif->index;
63
64 ide_device_add(idx);
65
66 ecard_set_drvdata(ec, hwif);
67 goto out;
68 }
69
70 release:
71 ecard_release_resources(ec);
72 out:
73 return ret;
74}
75
76static void __devexit rapide_remove(struct expansion_card *ec)
77{
78 ide_hwif_t *hwif = ecard_get_drvdata(ec);
79
80 ecard_set_drvdata(ec, NULL);
81
82 /* there must be a better way */
83 ide_unregister(hwif - ide_hwifs);
84 ecard_release_resources(ec);
85}
86
87static struct ecard_id rapide_ids[] = {
88 { MANU_YELLOWSTONE, PROD_YELLOWSTONE_RAPIDE32 },
89 { 0xffff, 0xffff }
90};
91
92static struct ecard_driver rapide_driver = {
93 .probe = rapide_probe,
94 .remove = __devexit_p(rapide_remove),
95 .id_table = rapide_ids,
96 .drv = {
97 .name = "rapide",
98 },
99};
100
101static int __init rapide_init(void)
102{
103 return ecard_register_driver(&rapide_driver);
104}
105
106MODULE_LICENSE("GPL");
107MODULE_DESCRIPTION("Yellowstone RAPIDE driver");
108
109module_init(rapide_init);