]>
Commit | Line | Data |
---|---|---|
1da177e4 LT |
1 | /* |
2 | * cpcihp_generic.c | |
3 | * | |
4 | * Generic port I/O CompactPCI driver | |
5 | * | |
6 | * Copyright 2002 SOMA Networks, Inc. | |
7 | * Copyright 2001 Intel San Luis Obispo | |
8 | * Copyright 2000,2001 MontaVista Software Inc. | |
9 | * | |
10 | * This program is free software; you can redistribute it and/or modify it | |
11 | * under the terms of the GNU General Public License as published by the | |
12 | * Free Software Foundation; either version 2 of the License, or (at your | |
13 | * option) any later version. | |
14 | * | |
15 | * THIS SOFTWARE IS PROVIDED "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, | |
16 | * INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY | |
17 | * AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL | |
18 | * THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, | |
19 | * EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, | |
20 | * PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR | |
21 | * PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF | |
22 | * LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING | |
23 | * NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS | |
24 | * SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. | |
25 | * | |
26 | * You should have received a copy of the GNU General Public License along | |
27 | * with this program; if not, write to the Free Software Foundation, Inc., | |
28 | * 675 Mass Ave, Cambridge, MA 02139, USA. | |
29 | * | |
30 | * This generic CompactPCI hotplug driver should allow using the PCI hotplug | |
31 | * mechanism on any CompactPCI board that exposes the #ENUM signal as a bit | |
32 | * in a system register that can be read through standard port I/O. | |
33 | * | |
34 | * Send feedback to <scottm@somanetworks.com> | |
35 | */ | |
36 | ||
1da177e4 LT |
37 | #include <linux/module.h> |
38 | #include <linux/init.h> | |
39 | #include <linux/errno.h> | |
40 | #include <linux/pci.h> | |
4e57b681 | 41 | #include <linux/string.h> |
1da177e4 LT |
42 | #include "cpci_hotplug.h" |
43 | ||
44 | #define DRIVER_VERSION "0.1" | |
45 | #define DRIVER_AUTHOR "Scott Murray <scottm@somanetworks.com>" | |
46 | #define DRIVER_DESC "Generic port I/O CompactPCI Hot Plug Driver" | |
47 | ||
48 | #if !defined(MODULE) | |
49 | #define MY_NAME "cpcihp_generic" | |
50 | #else | |
51 | #define MY_NAME THIS_MODULE->name | |
52 | #endif | |
53 | ||
54 | #define dbg(format, arg...) \ | |
55 | do { \ | |
56 | if(debug) \ | |
57 | printk (KERN_DEBUG "%s: " format "\n", \ | |
58 | MY_NAME , ## arg); \ | |
59 | } while(0) | |
60 | #define err(format, arg...) printk(KERN_ERR "%s: " format "\n", MY_NAME , ## arg) | |
61 | #define info(format, arg...) printk(KERN_INFO "%s: " format "\n", MY_NAME , ## arg) | |
62 | #define warn(format, arg...) printk(KERN_WARNING "%s: " format "\n", MY_NAME , ## arg) | |
63 | ||
64 | /* local variables */ | |
65 | static int debug; | |
66 | static char *bridge; | |
67 | static u8 bridge_busnr; | |
68 | static u8 bridge_slot; | |
69 | static struct pci_bus *bus; | |
70 | static u8 first_slot; | |
71 | static u8 last_slot; | |
72 | static u16 port; | |
73 | static unsigned int enum_bit; | |
74 | static u8 enum_mask; | |
75 | ||
76 | static struct cpci_hp_controller_ops generic_hpc_ops; | |
77 | static struct cpci_hp_controller generic_hpc; | |
78 | ||
79 | static int __init validate_parameters(void) | |
80 | { | |
81 | char* str; | |
82 | char* p; | |
83 | unsigned long tmp; | |
84 | ||
85 | if(!bridge) { | |
86 | info("not configured, disabling."); | |
49c61cca | 87 | return -EINVAL; |
1da177e4 LT |
88 | } |
89 | str = bridge; | |
90 | if(!*str) | |
91 | return -EINVAL; | |
92 | ||
93 | tmp = simple_strtoul(str, &p, 16); | |
94 | if(p == str || tmp > 0xff) { | |
95 | err("Invalid hotplug bus bridge device bus number"); | |
96 | return -EINVAL; | |
97 | } | |
98 | bridge_busnr = (u8) tmp; | |
99 | dbg("bridge_busnr = 0x%02x", bridge_busnr); | |
100 | if(*p != ':') { | |
101 | err("Invalid hotplug bus bridge device"); | |
102 | return -EINVAL; | |
103 | } | |
104 | str = p + 1; | |
105 | tmp = simple_strtoul(str, &p, 16); | |
106 | if(p == str || tmp > 0x1f) { | |
107 | err("Invalid hotplug bus bridge device slot number"); | |
108 | return -EINVAL; | |
109 | } | |
110 | bridge_slot = (u8) tmp; | |
111 | dbg("bridge_slot = 0x%02x", bridge_slot); | |
112 | ||
113 | dbg("first_slot = 0x%02x", first_slot); | |
114 | dbg("last_slot = 0x%02x", last_slot); | |
115 | if(!(first_slot && last_slot)) { | |
116 | err("Need to specify first_slot and last_slot"); | |
117 | return -EINVAL; | |
118 | } | |
119 | if(last_slot < first_slot) { | |
120 | err("first_slot must be less than last_slot"); | |
121 | return -EINVAL; | |
122 | } | |
123 | ||
124 | dbg("port = 0x%04x", port); | |
125 | dbg("enum_bit = 0x%02x", enum_bit); | |
126 | if(enum_bit > 7) { | |
127 | err("Invalid #ENUM bit"); | |
128 | return -EINVAL; | |
129 | } | |
130 | enum_mask = 1 << enum_bit; | |
131 | return 0; | |
132 | } | |
133 | ||
134 | static int query_enum(void) | |
135 | { | |
136 | u8 value; | |
137 | ||
138 | value = inb_p(port); | |
139 | return ((value & enum_mask) == enum_mask); | |
140 | } | |
141 | ||
142 | static int __init cpcihp_generic_init(void) | |
143 | { | |
144 | int status; | |
145 | struct resource* r; | |
146 | struct pci_dev* dev; | |
147 | ||
148 | info(DRIVER_DESC " version: " DRIVER_VERSION); | |
149 | status = validate_parameters(); | |
49c61cca | 150 | if (status) |
1da177e4 LT |
151 | return status; |
152 | ||
153 | r = request_region(port, 1, "#ENUM hotswap signal register"); | |
154 | if(!r) | |
155 | return -EBUSY; | |
156 | ||
33ae6ef2 GKH |
157 | bus = pci_find_bus(0, bridge_busnr); |
158 | if (!bus) { | |
159 | err("Invalid bus number %d", bridge_busnr); | |
160 | return -EINVAL; | |
161 | } | |
162 | dev = pci_get_slot(bus, PCI_DEVFN(bridge_slot, 0)); | |
1da177e4 LT |
163 | if(!dev || dev->hdr_type != PCI_HEADER_TYPE_BRIDGE) { |
164 | err("Invalid bridge device %s", bridge); | |
165 | return -EINVAL; | |
166 | } | |
167 | bus = dev->subordinate; | |
33ae6ef2 | 168 | pci_dev_put(dev); |
1da177e4 LT |
169 | |
170 | memset(&generic_hpc, 0, sizeof (struct cpci_hp_controller)); | |
171 | generic_hpc_ops.query_enum = query_enum; | |
172 | generic_hpc.ops = &generic_hpc_ops; | |
173 | ||
174 | status = cpci_hp_register_controller(&generic_hpc); | |
175 | if(status != 0) { | |
176 | err("Could not register cPCI hotplug controller"); | |
177 | return -ENODEV; | |
178 | } | |
179 | dbg("registered controller"); | |
180 | ||
181 | status = cpci_hp_register_bus(bus, first_slot, last_slot); | |
182 | if(status != 0) { | |
183 | err("Could not register cPCI hotplug bus"); | |
184 | goto init_bus_register_error; | |
185 | } | |
186 | dbg("registered bus"); | |
187 | ||
188 | status = cpci_hp_start(); | |
189 | if(status != 0) { | |
190 | err("Could not started cPCI hotplug system"); | |
191 | goto init_start_error; | |
192 | } | |
193 | dbg("started cpci hp system"); | |
194 | return 0; | |
195 | init_start_error: | |
196 | cpci_hp_unregister_bus(bus); | |
197 | init_bus_register_error: | |
198 | cpci_hp_unregister_controller(&generic_hpc); | |
199 | err("status = %d", status); | |
200 | return status; | |
201 | ||
202 | } | |
203 | ||
204 | static void __exit cpcihp_generic_exit(void) | |
205 | { | |
206 | cpci_hp_stop(); | |
207 | cpci_hp_unregister_bus(bus); | |
208 | cpci_hp_unregister_controller(&generic_hpc); | |
209 | release_region(port, 1); | |
210 | } | |
211 | ||
212 | module_init(cpcihp_generic_init); | |
213 | module_exit(cpcihp_generic_exit); | |
214 | ||
215 | MODULE_AUTHOR(DRIVER_AUTHOR); | |
216 | MODULE_DESCRIPTION(DRIVER_DESC); | |
217 | MODULE_LICENSE("GPL"); | |
218 | module_param(debug, bool, S_IRUGO | S_IWUSR); | |
219 | MODULE_PARM_DESC(debug, "Debugging mode enabled or not"); | |
220 | module_param(bridge, charp, 0); | |
221 | MODULE_PARM_DESC(bridge, "Hotswap bus bridge device, <bus>:<slot> (bus and slot are in hexadecimal)"); | |
222 | module_param(first_slot, byte, 0); | |
223 | MODULE_PARM_DESC(first_slot, "Hotswap bus first slot number"); | |
224 | module_param(last_slot, byte, 0); | |
225 | MODULE_PARM_DESC(last_slot, "Hotswap bus last slot number"); | |
226 | module_param(port, ushort, 0); | |
227 | MODULE_PARM_DESC(port, "#ENUM signal I/O port"); | |
228 | module_param(enum_bit, uint, 0); | |
229 | MODULE_PARM_DESC(enum_bit, "#ENUM signal bit (0-7)"); |