]>
Commit | Line | Data |
---|---|---|
4237f229 RB |
1 | /* |
2 | * Copyright (C) 2001, 2002, 2003 Broadcom Corporation | |
3 | * Copyright (C) 2004 MontaVista Software Inc. | |
4 | * Author: Manish Lachwani, mlachwani@mvista.com | |
5 | * Copyright (C) 2004 MIPS Technologies, Inc. All rights reserved. | |
6 | * Author: Maciej W. Rozycki <macro@mips.com> | |
4d4423ca | 7 | * Copyright (c) 2006, 2008 Maciej W. Rozycki |
4237f229 RB |
8 | * |
9 | * This program is free software; you can redistribute it and/or | |
10 | * modify it under the terms of the GNU General Public License | |
11 | * as published by the Free Software Foundation; either version 2 | |
12 | * of the License, or (at your option) any later version. | |
13 | * | |
14 | * This program is distributed in the hope that it will be useful, | |
15 | * but WITHOUT ANY WARRANTY; without even the implied warranty of | |
16 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the | |
17 | * GNU General Public License for more details. | |
18 | * | |
19 | * You should have received a copy of the GNU General Public License | |
20 | * along with this program; if not, write to the Free Software | |
21 | * Foundation, Inc., 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA. | |
22 | */ | |
23 | ||
24 | /* | |
25 | * Derived loosely from ide-pmac.c, so: | |
26 | * Copyright (C) 1998 Paul Mackerras. | |
27 | * Copyright (C) 1995-1998 Mark Lord | |
28 | */ | |
29 | ||
30 | /* | |
31 | * Boards with SiByte processors so far have supported IDE devices via | |
32 | * the Generic Bus, PCI bus, and built-in PCMCIA interface. In all | |
33 | * cases, byte-swapping must be avoided for these devices (whereas | |
34 | * other PCI devices, for example, will require swapping). Any | |
35 | * SiByte-targetted kernel including IDE support will include this | |
36 | * file. Probing of a Generic Bus for an IDE device is controlled by | |
37 | * the definition of "SIBYTE_HAVE_IDE", which is provided by | |
38 | * <asm/sibyte/board.h> for Broadcom boards. | |
39 | */ | |
40 | ||
41 | #include <linux/ide.h> | |
42 | #include <linux/ioport.h> | |
43 | #include <linux/kernel.h> | |
44 | #include <linux/types.h> | |
45 | #include <linux/platform_device.h> | |
46 | ||
47 | #include <asm/io.h> | |
48 | ||
49 | #include <asm/sibyte/board.h> | |
50 | #include <asm/sibyte/sb1250_genbus.h> | |
51 | #include <asm/sibyte/sb1250_regs.h> | |
52 | ||
53 | #define DRV_NAME "ide-swarm" | |
54 | ||
55 | static char swarm_ide_string[] = DRV_NAME; | |
56 | ||
57 | static struct resource swarm_ide_resource = { | |
58 | .name = "SWARM GenBus IDE", | |
59 | .flags = IORESOURCE_MEM, | |
60 | }; | |
61 | ||
62 | static struct platform_device *swarm_ide_dev; | |
63 | ||
e48905e9 | 64 | static const struct ide_port_info swarm_port_info = { |
eb3aff55 | 65 | .name = DRV_NAME, |
e48905e9 BZ |
66 | .host_flags = IDE_HFLAG_MMIO | IDE_HFLAG_NO_DMA, |
67 | }; | |
68 | ||
4237f229 RB |
69 | /* |
70 | * swarm_ide_probe - if the board header indicates the existence of | |
71 | * Generic Bus IDE, allocate a HWIF for it. | |
72 | */ | |
73 | static int __devinit swarm_ide_probe(struct device *dev) | |
74 | { | |
4237f229 | 75 | u8 __iomem *base; |
48c3c107 | 76 | struct ide_host *host; |
4237f229 RB |
77 | phys_t offset, size; |
78 | int i; | |
c97c6aca | 79 | hw_regs_t hw, *hws[] = { &hw, NULL, NULL, NULL }; |
4237f229 RB |
80 | |
81 | if (!SIBYTE_HAVE_IDE) | |
82 | return -ENODEV; | |
83 | ||
4237f229 RB |
84 | base = ioremap(A_IO_EXT_BASE, 0x800); |
85 | offset = __raw_readq(base + R_IO_EXT_REG(R_IO_EXT_START_ADDR, IDE_CS)); | |
86 | size = __raw_readq(base + R_IO_EXT_REG(R_IO_EXT_MULT_SIZE, IDE_CS)); | |
87 | iounmap(base); | |
88 | ||
89 | offset = G_IO_START_ADDR(offset) << S_IO_ADDRBASE; | |
90 | size = (G_IO_MULT_SIZE(size) + 1) << S_IO_REGSIZE; | |
91 | if (offset < A_PHYS_GENBUS || offset >= A_PHYS_GENBUS_END) { | |
92 | printk(KERN_INFO DRV_NAME | |
93 | ": IDE interface at GenBus disabled\n"); | |
94 | return -EBUSY; | |
95 | } | |
96 | ||
97 | printk(KERN_INFO DRV_NAME ": IDE interface at GenBus slot %i\n", | |
98 | IDE_CS); | |
99 | ||
100 | swarm_ide_resource.start = offset; | |
101 | swarm_ide_resource.end = offset + size - 1; | |
102 | if (request_resource(&iomem_resource, &swarm_ide_resource)) { | |
103 | printk(KERN_ERR DRV_NAME | |
104 | ": can't request I/O memory resource\n"); | |
105 | return -EBUSY; | |
106 | } | |
107 | ||
108 | base = ioremap(offset, size); | |
109 | ||
4c3032d8 | 110 | for (i = 0; i <= 7; i++) |
4d4423ca | 111 | hw.io_ports_array[i] = |
4237f229 | 112 | (unsigned long)(base + ((0x1f0 + i) << 5)); |
4d4423ca | 113 | hw.io_ports.ctl_addr = |
4237f229 | 114 | (unsigned long)(base + (0x3f6 << 5)); |
4d4423ca MR |
115 | hw.irq = K_INT_GB_IDE; |
116 | hw.chipset = ide_generic; | |
117 | ||
48c3c107 BZ |
118 | host = ide_host_alloc(&swarm_port_info, hws); |
119 | if (host == NULL) | |
cb8ea092 BZ |
120 | goto err; |
121 | ||
48c3c107 | 122 | ide_host_register(host, &swarm_port_info, hws); |
5cbf79cd | 123 | |
48c3c107 | 124 | dev_set_drvdata(dev, host); |
4237f229 RB |
125 | |
126 | return 0; | |
cb8ea092 BZ |
127 | err: |
128 | release_resource(&swarm_ide_resource); | |
129 | iounmap(base); | |
130 | return -ENOMEM; | |
4237f229 RB |
131 | } |
132 | ||
133 | static struct device_driver swarm_ide_driver = { | |
134 | .name = swarm_ide_string, | |
135 | .bus = &platform_bus_type, | |
136 | .probe = swarm_ide_probe, | |
137 | }; | |
138 | ||
139 | static void swarm_ide_platform_release(struct device *device) | |
140 | { | |
141 | struct platform_device *pldev; | |
142 | ||
143 | /* free device */ | |
144 | pldev = to_platform_device(device); | |
145 | kfree(pldev); | |
146 | } | |
147 | ||
148 | static int __devinit swarm_ide_init_module(void) | |
149 | { | |
150 | struct platform_device *pldev; | |
151 | int err; | |
152 | ||
153 | printk(KERN_INFO "SWARM IDE driver\n"); | |
154 | ||
155 | if (driver_register(&swarm_ide_driver)) { | |
156 | printk(KERN_ERR "Driver registration failed\n"); | |
157 | err = -ENODEV; | |
158 | goto out; | |
159 | } | |
160 | ||
dd00cc48 | 161 | if (!(pldev = kzalloc(sizeof (*pldev), GFP_KERNEL))) { |
4237f229 RB |
162 | err = -ENOMEM; |
163 | goto out_unregister_driver; | |
164 | } | |
165 | ||
4237f229 RB |
166 | pldev->name = swarm_ide_string; |
167 | pldev->id = 0; | |
168 | pldev->dev.release = swarm_ide_platform_release; | |
169 | ||
170 | if (platform_device_register(pldev)) { | |
171 | err = -ENODEV; | |
172 | goto out_free_pldev; | |
173 | } | |
174 | ||
175 | if (!pldev->dev.driver) { | |
176 | /* | |
177 | * The driver was not bound to this device, there was | |
178 | * no hardware at this address. Unregister it, as the | |
179 | * release fuction will take care of freeing the | |
180 | * allocated structure | |
181 | */ | |
182 | platform_device_unregister (pldev); | |
183 | } | |
184 | ||
185 | swarm_ide_dev = pldev; | |
186 | ||
187 | return 0; | |
188 | ||
189 | out_free_pldev: | |
190 | kfree(pldev); | |
191 | ||
192 | out_unregister_driver: | |
193 | driver_unregister(&swarm_ide_driver); | |
194 | out: | |
195 | return err; | |
196 | } | |
197 | ||
198 | module_init(swarm_ide_init_module); |