4 * Copyright (C) 2007 MontaVista Software
6 * Maintainer: Kumar Gala <galak@kernel.crashing.org>
8 * This program is free software; you can redistribute it and/or modify it
9 * under the terms of the GNU General Public License as published by the
10 * Free Software Foundation; either version 2 of the License, or (at your
11 * option) any later version.
14 #include <linux/types.h>
15 #include <linux/init.h>
16 #include <linux/kernel.h>
17 #include <linux/ide.h>
18 #include <linux/ioport.h>
19 #include <linux/module.h>
20 #include <linux/pata_platform.h>
21 #include <linux/platform_device.h>
25 void __iomem
*plat_ide_mapbase
;
26 void __iomem
*plat_ide_alt_mapbase
;
31 static void __devinit
plat_ide_setup_ports(hw_regs_t
*hw
,
34 struct pata_platform_info
*pdata
,
37 unsigned long port
= (unsigned long)base
;
40 hw
->io_ports
[IDE_DATA_OFFSET
] = port
;
42 port
+= (1 << pdata
->ioport_shift
);
43 for (i
= IDE_ERROR_OFFSET
; i
<= IDE_STATUS_OFFSET
;
44 i
++, port
+= (1 << pdata
->ioport_shift
))
45 hw
->io_ports
[i
] = port
;
47 hw
->io_ports
[IDE_CONTROL_OFFSET
] = (unsigned long)ctrl
;
51 hw
->chipset
= ide_generic
;
54 static int __devinit
plat_ide_probe(struct platform_device
*pdev
)
56 struct resource
*res_base
, *res_alt
, *res_irq
;
58 struct pata_platform_info
*pdata
;
59 u8 idx
[4] = { 0xff, 0xff, 0xff, 0xff };
64 pdata
= pdev
->dev
.platform_data
;
66 /* get a pointer to the register memory */
67 res_base
= platform_get_resource(pdev
, IORESOURCE_IO
, 0);
68 res_alt
= platform_get_resource(pdev
, IORESOURCE_IO
, 1);
70 if (!res_base
|| !res_alt
) {
71 res_base
= platform_get_resource(pdev
, IORESOURCE_MEM
, 0);
72 res_alt
= platform_get_resource(pdev
, IORESOURCE_MEM
, 1);
73 if (!res_base
|| !res_alt
) {
80 res_irq
= platform_get_resource(pdev
, IORESOURCE_IRQ
, 0);
87 hwif_prop
.plat_ide_mapbase
= devm_ioremap(&pdev
->dev
,
88 res_base
->start
, res_base
->end
- res_base
->start
+ 1);
89 hwif_prop
.plat_ide_alt_mapbase
= devm_ioremap(&pdev
->dev
,
90 res_alt
->start
, res_alt
->end
- res_alt
->start
+ 1);
92 hwif_prop
.plat_ide_mapbase
= devm_ioport_map(&pdev
->dev
,
93 res_base
->start
, res_base
->end
- res_base
->start
+ 1);
94 hwif_prop
.plat_ide_alt_mapbase
= devm_ioport_map(&pdev
->dev
,
95 res_alt
->start
, res_alt
->end
- res_alt
->start
+ 1);
98 hwif
= ide_find_port((unsigned long)hwif_prop
.plat_ide_mapbase
);
104 memset(&hw
, 0, sizeof(hw
));
105 plat_ide_setup_ports(&hw
, hwif_prop
.plat_ide_mapbase
,
106 hwif_prop
.plat_ide_alt_mapbase
,
107 pdata
, res_irq
->start
);
110 ide_init_port_hw(hwif
, &hw
);
114 default_hwif_mmiops(hwif
);
117 hwif_prop
.hwif
= hwif
;
118 hwif_prop
.index
= hwif
->index
;
120 idx
[0] = hwif
->index
;
124 platform_set_drvdata(pdev
, hwif
);
132 static int __devexit
plat_ide_remove(struct platform_device
*pdev
)
134 ide_hwif_t
*hwif
= pdev
->dev
.driver_data
;
136 if (hwif
!= hwif_prop
.hwif
) {
137 dev_printk(KERN_DEBUG
, &pdev
->dev
, "%s: hwif value error",
140 ide_unregister(hwif_prop
.index
);
142 hwif_prop
.hwif
= NULL
;
148 static struct platform_driver platform_ide_driver
= {
150 .name
= "pata_platform",
152 .probe
= plat_ide_probe
,
153 .remove
= __devexit_p(plat_ide_remove
),
156 static int __init
platform_ide_init(void)
158 return platform_driver_register(&platform_ide_driver
);
161 static void __exit
platform_ide_exit(void)
163 platform_driver_unregister(&platform_ide_driver
);
166 MODULE_DESCRIPTION("Platform IDE driver");
167 MODULE_LICENSE("GPL");
169 module_init(platform_ide_init
);
170 module_exit(platform_ide_exit
);