Merge git://git.kernel.org/pub/scm/linux/kernel/git/gregkh/usb-2.6
[GitHub/mt8127/android_kernel_alcatel_ttab.git] / drivers / pci / hotplug / pci_hotplug_core.c
1 /*
2 * PCI HotPlug Controller Core
3 *
4 * Copyright (C) 2001-2002 Greg Kroah-Hartman (greg@kroah.com)
5 * Copyright (C) 2001-2002 IBM Corp.
6 *
7 * All rights reserved.
8 *
9 * This program is free software; you can redistribute it and/or modify
10 * it under the terms of the GNU General Public License as published by
11 * the Free Software Foundation; either version 2 of the License, or (at
12 * your option) any later version.
13 *
14 * This program is distributed in the hope that it will be useful, but
15 * WITHOUT ANY WARRANTY; without even the implied warranty of
16 * MERCHANTABILITY OR FITNESS FOR A PARTICULAR PURPOSE, GOOD TITLE or
17 * NON INFRINGEMENT. See the GNU General Public License for more
18 * details.
19 *
20 * You should have received a copy of the GNU General Public License
21 * along with this program; if not, write to the Free Software
22 * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
23 *
24 * Send feedback to <kristen.c.accardi@intel.com>
25 *
26 */
27
28 #include <linux/module.h>
29 #include <linux/moduleparam.h>
30 #include <linux/kernel.h>
31 #include <linux/types.h>
32 #include <linux/list.h>
33 #include <linux/kobject.h>
34 #include <linux/sysfs.h>
35 #include <linux/pagemap.h>
36 #include <linux/slab.h>
37 #include <linux/init.h>
38 #include <linux/mount.h>
39 #include <linux/namei.h>
40 #include <linux/mutex.h>
41 #include <linux/pci.h>
42 #include <linux/pci_hotplug.h>
43 #include <asm/uaccess.h>
44 #include "../pci.h"
45
46 #define MY_NAME "pci_hotplug"
47
48 #define dbg(fmt, arg...) do { if (debug) printk(KERN_DEBUG "%s: %s: " fmt , MY_NAME , __func__ , ## arg); } while (0)
49 #define err(format, arg...) printk(KERN_ERR "%s: " format , MY_NAME , ## arg)
50 #define info(format, arg...) printk(KERN_INFO "%s: " format , MY_NAME , ## arg)
51 #define warn(format, arg...) printk(KERN_WARNING "%s: " format , MY_NAME , ## arg)
52
53
54 /* local variables */
55 static int debug;
56
57 #define DRIVER_VERSION "0.5"
58 #define DRIVER_AUTHOR "Greg Kroah-Hartman <greg@kroah.com>, Scott Murray <scottm@somanetworks.com>"
59 #define DRIVER_DESC "PCI Hot Plug PCI Core"
60
61
62 //////////////////////////////////////////////////////////////////
63
64 static LIST_HEAD(pci_hotplug_slot_list);
65 static DEFINE_MUTEX(pci_hp_mutex);
66
67 /* these strings match up with the values in pci_bus_speed */
68 static char *pci_bus_speed_strings[] = {
69 "33 MHz PCI", /* 0x00 */
70 "66 MHz PCI", /* 0x01 */
71 "66 MHz PCIX", /* 0x02 */
72 "100 MHz PCIX", /* 0x03 */
73 "133 MHz PCIX", /* 0x04 */
74 NULL, /* 0x05 */
75 NULL, /* 0x06 */
76 NULL, /* 0x07 */
77 NULL, /* 0x08 */
78 "66 MHz PCIX 266", /* 0x09 */
79 "100 MHz PCIX 266", /* 0x0a */
80 "133 MHz PCIX 266", /* 0x0b */
81 NULL, /* 0x0c */
82 NULL, /* 0x0d */
83 NULL, /* 0x0e */
84 NULL, /* 0x0f */
85 NULL, /* 0x10 */
86 "66 MHz PCIX 533", /* 0x11 */
87 "100 MHz PCIX 533", /* 0x12 */
88 "133 MHz PCIX 533", /* 0x13 */
89 "25 GBps PCI-E", /* 0x14 */
90 };
91
92 #ifdef CONFIG_HOTPLUG_PCI_CPCI
93 extern int cpci_hotplug_init(int debug);
94 extern void cpci_hotplug_exit(void);
95 #else
96 static inline int cpci_hotplug_init(int debug) { return 0; }
97 static inline void cpci_hotplug_exit(void) { }
98 #endif
99
100 /* Weee, fun with macros... */
101 #define GET_STATUS(name,type) \
102 static int get_##name (struct hotplug_slot *slot, type *value) \
103 { \
104 struct hotplug_slot_ops *ops = slot->ops; \
105 int retval = 0; \
106 if (!try_module_get(ops->owner)) \
107 return -ENODEV; \
108 if (ops->get_##name) \
109 retval = ops->get_##name(slot, value); \
110 else \
111 *value = slot->info->name; \
112 module_put(ops->owner); \
113 return retval; \
114 }
115
116 GET_STATUS(power_status, u8)
117 GET_STATUS(attention_status, u8)
118 GET_STATUS(latch_status, u8)
119 GET_STATUS(adapter_status, u8)
120 GET_STATUS(max_bus_speed, enum pci_bus_speed)
121 GET_STATUS(cur_bus_speed, enum pci_bus_speed)
122
123 static ssize_t power_read_file(struct pci_slot *slot, char *buf)
124 {
125 int retval;
126 u8 value;
127
128 retval = get_power_status(slot->hotplug, &value);
129 if (retval)
130 goto exit;
131 retval = sprintf (buf, "%d\n", value);
132 exit:
133 return retval;
134 }
135
136 static ssize_t power_write_file(struct pci_slot *pci_slot, const char *buf,
137 size_t count)
138 {
139 struct hotplug_slot *slot = pci_slot->hotplug;
140 unsigned long lpower;
141 u8 power;
142 int retval = 0;
143
144 lpower = simple_strtoul (buf, NULL, 10);
145 power = (u8)(lpower & 0xff);
146 dbg ("power = %d\n", power);
147
148 if (!try_module_get(slot->ops->owner)) {
149 retval = -ENODEV;
150 goto exit;
151 }
152 switch (power) {
153 case 0:
154 if (slot->ops->disable_slot)
155 retval = slot->ops->disable_slot(slot);
156 break;
157
158 case 1:
159 if (slot->ops->enable_slot)
160 retval = slot->ops->enable_slot(slot);
161 break;
162
163 default:
164 err ("Illegal value specified for power\n");
165 retval = -EINVAL;
166 }
167 module_put(slot->ops->owner);
168
169 exit:
170 if (retval)
171 return retval;
172 return count;
173 }
174
175 static struct pci_slot_attribute hotplug_slot_attr_power = {
176 .attr = {.name = "power", .mode = S_IFREG | S_IRUGO | S_IWUSR},
177 .show = power_read_file,
178 .store = power_write_file
179 };
180
181 static ssize_t attention_read_file(struct pci_slot *slot, char *buf)
182 {
183 int retval;
184 u8 value;
185
186 retval = get_attention_status(slot->hotplug, &value);
187 if (retval)
188 goto exit;
189 retval = sprintf(buf, "%d\n", value);
190
191 exit:
192 return retval;
193 }
194
195 static ssize_t attention_write_file(struct pci_slot *slot, const char *buf,
196 size_t count)
197 {
198 struct hotplug_slot_ops *ops = slot->hotplug->ops;
199 unsigned long lattention;
200 u8 attention;
201 int retval = 0;
202
203 lattention = simple_strtoul (buf, NULL, 10);
204 attention = (u8)(lattention & 0xff);
205 dbg (" - attention = %d\n", attention);
206
207 if (!try_module_get(ops->owner)) {
208 retval = -ENODEV;
209 goto exit;
210 }
211 if (ops->set_attention_status)
212 retval = ops->set_attention_status(slot->hotplug, attention);
213 module_put(ops->owner);
214
215 exit:
216 if (retval)
217 return retval;
218 return count;
219 }
220
221 static struct pci_slot_attribute hotplug_slot_attr_attention = {
222 .attr = {.name = "attention", .mode = S_IFREG | S_IRUGO | S_IWUSR},
223 .show = attention_read_file,
224 .store = attention_write_file
225 };
226
227 static ssize_t latch_read_file(struct pci_slot *slot, char *buf)
228 {
229 int retval;
230 u8 value;
231
232 retval = get_latch_status(slot->hotplug, &value);
233 if (retval)
234 goto exit;
235 retval = sprintf (buf, "%d\n", value);
236
237 exit:
238 return retval;
239 }
240
241 static struct pci_slot_attribute hotplug_slot_attr_latch = {
242 .attr = {.name = "latch", .mode = S_IFREG | S_IRUGO},
243 .show = latch_read_file,
244 };
245
246 static ssize_t presence_read_file(struct pci_slot *slot, char *buf)
247 {
248 int retval;
249 u8 value;
250
251 retval = get_adapter_status(slot->hotplug, &value);
252 if (retval)
253 goto exit;
254 retval = sprintf (buf, "%d\n", value);
255
256 exit:
257 return retval;
258 }
259
260 static struct pci_slot_attribute hotplug_slot_attr_presence = {
261 .attr = {.name = "adapter", .mode = S_IFREG | S_IRUGO},
262 .show = presence_read_file,
263 };
264
265 static char *unknown_speed = "Unknown bus speed";
266
267 static ssize_t max_bus_speed_read_file(struct pci_slot *slot, char *buf)
268 {
269 char *speed_string;
270 int retval;
271 enum pci_bus_speed value;
272
273 retval = get_max_bus_speed(slot->hotplug, &value);
274 if (retval)
275 goto exit;
276
277 if (value == PCI_SPEED_UNKNOWN)
278 speed_string = unknown_speed;
279 else
280 speed_string = pci_bus_speed_strings[value];
281
282 retval = sprintf (buf, "%s\n", speed_string);
283
284 exit:
285 return retval;
286 }
287
288 static struct pci_slot_attribute hotplug_slot_attr_max_bus_speed = {
289 .attr = {.name = "max_bus_speed", .mode = S_IFREG | S_IRUGO},
290 .show = max_bus_speed_read_file,
291 };
292
293 static ssize_t cur_bus_speed_read_file(struct pci_slot *slot, char *buf)
294 {
295 char *speed_string;
296 int retval;
297 enum pci_bus_speed value;
298
299 retval = get_cur_bus_speed(slot->hotplug, &value);
300 if (retval)
301 goto exit;
302
303 if (value == PCI_SPEED_UNKNOWN)
304 speed_string = unknown_speed;
305 else
306 speed_string = pci_bus_speed_strings[value];
307
308 retval = sprintf (buf, "%s\n", speed_string);
309
310 exit:
311 return retval;
312 }
313
314 static struct pci_slot_attribute hotplug_slot_attr_cur_bus_speed = {
315 .attr = {.name = "cur_bus_speed", .mode = S_IFREG | S_IRUGO},
316 .show = cur_bus_speed_read_file,
317 };
318
319 static ssize_t test_write_file(struct pci_slot *pci_slot, const char *buf,
320 size_t count)
321 {
322 struct hotplug_slot *slot = pci_slot->hotplug;
323 unsigned long ltest;
324 u32 test;
325 int retval = 0;
326
327 ltest = simple_strtoul (buf, NULL, 10);
328 test = (u32)(ltest & 0xffffffff);
329 dbg ("test = %d\n", test);
330
331 if (!try_module_get(slot->ops->owner)) {
332 retval = -ENODEV;
333 goto exit;
334 }
335 if (slot->ops->hardware_test)
336 retval = slot->ops->hardware_test(slot, test);
337 module_put(slot->ops->owner);
338
339 exit:
340 if (retval)
341 return retval;
342 return count;
343 }
344
345 static struct pci_slot_attribute hotplug_slot_attr_test = {
346 .attr = {.name = "test", .mode = S_IFREG | S_IRUGO | S_IWUSR},
347 .store = test_write_file
348 };
349
350 static bool has_power_file(struct pci_slot *pci_slot)
351 {
352 struct hotplug_slot *slot = pci_slot->hotplug;
353 if ((!slot) || (!slot->ops))
354 return false;
355 if ((slot->ops->enable_slot) ||
356 (slot->ops->disable_slot) ||
357 (slot->ops->get_power_status))
358 return true;
359 return false;
360 }
361
362 static bool has_attention_file(struct pci_slot *pci_slot)
363 {
364 struct hotplug_slot *slot = pci_slot->hotplug;
365 if ((!slot) || (!slot->ops))
366 return false;
367 if ((slot->ops->set_attention_status) ||
368 (slot->ops->get_attention_status))
369 return true;
370 return false;
371 }
372
373 static bool has_latch_file(struct pci_slot *pci_slot)
374 {
375 struct hotplug_slot *slot = pci_slot->hotplug;
376 if ((!slot) || (!slot->ops))
377 return false;
378 if (slot->ops->get_latch_status)
379 return true;
380 return false;
381 }
382
383 static bool has_adapter_file(struct pci_slot *pci_slot)
384 {
385 struct hotplug_slot *slot = pci_slot->hotplug;
386 if ((!slot) || (!slot->ops))
387 return false;
388 if (slot->ops->get_adapter_status)
389 return true;
390 return false;
391 }
392
393 static bool has_max_bus_speed_file(struct pci_slot *pci_slot)
394 {
395 struct hotplug_slot *slot = pci_slot->hotplug;
396 if ((!slot) || (!slot->ops))
397 return false;
398 if (slot->ops->get_max_bus_speed)
399 return true;
400 return false;
401 }
402
403 static bool has_cur_bus_speed_file(struct pci_slot *pci_slot)
404 {
405 struct hotplug_slot *slot = pci_slot->hotplug;
406 if ((!slot) || (!slot->ops))
407 return false;
408 if (slot->ops->get_cur_bus_speed)
409 return true;
410 return false;
411 }
412
413 static bool has_test_file(struct pci_slot *pci_slot)
414 {
415 struct hotplug_slot *slot = pci_slot->hotplug;
416 if ((!slot) || (!slot->ops))
417 return false;
418 if (slot->ops->hardware_test)
419 return true;
420 return false;
421 }
422
423 static int fs_add_slot(struct pci_slot *slot)
424 {
425 int retval = 0;
426
427 /* Create symbolic link to the hotplug driver module */
428 pci_hp_create_module_link(slot);
429
430 if (has_power_file(slot)) {
431 retval = sysfs_create_file(&slot->kobj,
432 &hotplug_slot_attr_power.attr);
433 if (retval)
434 goto exit_power;
435 }
436
437 if (has_attention_file(slot)) {
438 retval = sysfs_create_file(&slot->kobj,
439 &hotplug_slot_attr_attention.attr);
440 if (retval)
441 goto exit_attention;
442 }
443
444 if (has_latch_file(slot)) {
445 retval = sysfs_create_file(&slot->kobj,
446 &hotplug_slot_attr_latch.attr);
447 if (retval)
448 goto exit_latch;
449 }
450
451 if (has_adapter_file(slot)) {
452 retval = sysfs_create_file(&slot->kobj,
453 &hotplug_slot_attr_presence.attr);
454 if (retval)
455 goto exit_adapter;
456 }
457
458 if (has_max_bus_speed_file(slot)) {
459 retval = sysfs_create_file(&slot->kobj,
460 &hotplug_slot_attr_max_bus_speed.attr);
461 if (retval)
462 goto exit_max_speed;
463 }
464
465 if (has_cur_bus_speed_file(slot)) {
466 retval = sysfs_create_file(&slot->kobj,
467 &hotplug_slot_attr_cur_bus_speed.attr);
468 if (retval)
469 goto exit_cur_speed;
470 }
471
472 if (has_test_file(slot)) {
473 retval = sysfs_create_file(&slot->kobj,
474 &hotplug_slot_attr_test.attr);
475 if (retval)
476 goto exit_test;
477 }
478
479 goto exit;
480
481 exit_test:
482 if (has_cur_bus_speed_file(slot))
483 sysfs_remove_file(&slot->kobj,
484 &hotplug_slot_attr_cur_bus_speed.attr);
485 exit_cur_speed:
486 if (has_max_bus_speed_file(slot))
487 sysfs_remove_file(&slot->kobj,
488 &hotplug_slot_attr_max_bus_speed.attr);
489 exit_max_speed:
490 if (has_adapter_file(slot))
491 sysfs_remove_file(&slot->kobj,
492 &hotplug_slot_attr_presence.attr);
493 exit_adapter:
494 if (has_latch_file(slot))
495 sysfs_remove_file(&slot->kobj, &hotplug_slot_attr_latch.attr);
496 exit_latch:
497 if (has_attention_file(slot))
498 sysfs_remove_file(&slot->kobj,
499 &hotplug_slot_attr_attention.attr);
500 exit_attention:
501 if (has_power_file(slot))
502 sysfs_remove_file(&slot->kobj, &hotplug_slot_attr_power.attr);
503 exit_power:
504 pci_hp_remove_module_link(slot);
505 exit:
506 return retval;
507 }
508
509 static void fs_remove_slot(struct pci_slot *slot)
510 {
511 if (has_power_file(slot))
512 sysfs_remove_file(&slot->kobj, &hotplug_slot_attr_power.attr);
513
514 if (has_attention_file(slot))
515 sysfs_remove_file(&slot->kobj,
516 &hotplug_slot_attr_attention.attr);
517
518 if (has_latch_file(slot))
519 sysfs_remove_file(&slot->kobj, &hotplug_slot_attr_latch.attr);
520
521 if (has_adapter_file(slot))
522 sysfs_remove_file(&slot->kobj,
523 &hotplug_slot_attr_presence.attr);
524
525 if (has_max_bus_speed_file(slot))
526 sysfs_remove_file(&slot->kobj,
527 &hotplug_slot_attr_max_bus_speed.attr);
528
529 if (has_cur_bus_speed_file(slot))
530 sysfs_remove_file(&slot->kobj,
531 &hotplug_slot_attr_cur_bus_speed.attr);
532
533 if (has_test_file(slot))
534 sysfs_remove_file(&slot->kobj, &hotplug_slot_attr_test.attr);
535
536 pci_hp_remove_module_link(slot);
537 }
538
539 static struct hotplug_slot *get_slot_from_name (const char *name)
540 {
541 struct hotplug_slot *slot;
542 struct list_head *tmp;
543
544 list_for_each (tmp, &pci_hotplug_slot_list) {
545 slot = list_entry (tmp, struct hotplug_slot, slot_list);
546 if (strcmp(hotplug_slot_name(slot), name) == 0)
547 return slot;
548 }
549 return NULL;
550 }
551
552 /**
553 * __pci_hp_register - register a hotplug_slot with the PCI hotplug subsystem
554 * @bus: bus this slot is on
555 * @slot: pointer to the &struct hotplug_slot to register
556 * @devnr: device number
557 * @name: name registered with kobject core
558 * @owner: caller module owner
559 * @mod_name: caller module name
560 *
561 * Registers a hotplug slot with the pci hotplug subsystem, which will allow
562 * userspace interaction to the slot.
563 *
564 * Returns 0 if successful, anything else for an error.
565 */
566 int __pci_hp_register(struct hotplug_slot *slot, struct pci_bus *bus,
567 int devnr, const char *name,
568 struct module *owner, const char *mod_name)
569 {
570 int result;
571 struct pci_slot *pci_slot;
572
573 if (slot == NULL)
574 return -ENODEV;
575 if ((slot->info == NULL) || (slot->ops == NULL))
576 return -EINVAL;
577 if (slot->release == NULL) {
578 dbg("Why are you trying to register a hotplug slot "
579 "without a proper release function?\n");
580 return -EINVAL;
581 }
582
583 slot->ops->owner = owner;
584 slot->ops->mod_name = mod_name;
585
586 mutex_lock(&pci_hp_mutex);
587 /*
588 * No problems if we call this interface from both ACPI_PCI_SLOT
589 * driver and call it here again. If we've already created the
590 * pci_slot, the interface will simply bump the refcount.
591 */
592 pci_slot = pci_create_slot(bus, devnr, name, slot);
593 if (IS_ERR(pci_slot)) {
594 result = PTR_ERR(pci_slot);
595 goto out;
596 }
597
598 slot->pci_slot = pci_slot;
599 pci_slot->hotplug = slot;
600
601 list_add(&slot->slot_list, &pci_hotplug_slot_list);
602
603 result = fs_add_slot(pci_slot);
604 kobject_uevent(&pci_slot->kobj, KOBJ_ADD);
605 dbg("Added slot %s to the list\n", name);
606 out:
607 mutex_unlock(&pci_hp_mutex);
608 return result;
609 }
610
611 /**
612 * pci_hp_deregister - deregister a hotplug_slot with the PCI hotplug subsystem
613 * @hotplug: pointer to the &struct hotplug_slot to deregister
614 *
615 * The @slot must have been registered with the pci hotplug subsystem
616 * previously with a call to pci_hp_register().
617 *
618 * Returns 0 if successful, anything else for an error.
619 */
620 int pci_hp_deregister(struct hotplug_slot *hotplug)
621 {
622 struct hotplug_slot *temp;
623 struct pci_slot *slot;
624
625 if (!hotplug)
626 return -ENODEV;
627
628 mutex_lock(&pci_hp_mutex);
629 temp = get_slot_from_name(hotplug_slot_name(hotplug));
630 if (temp != hotplug) {
631 mutex_unlock(&pci_hp_mutex);
632 return -ENODEV;
633 }
634
635 list_del(&hotplug->slot_list);
636
637 slot = hotplug->pci_slot;
638 fs_remove_slot(slot);
639 dbg("Removed slot %s from the list\n", hotplug_slot_name(hotplug));
640
641 hotplug->release(hotplug);
642 slot->hotplug = NULL;
643 pci_destroy_slot(slot);
644 mutex_unlock(&pci_hp_mutex);
645
646 return 0;
647 }
648
649 /**
650 * pci_hp_change_slot_info - changes the slot's information structure in the core
651 * @hotplug: pointer to the slot whose info has changed
652 * @info: pointer to the info copy into the slot's info structure
653 *
654 * @slot must have been registered with the pci
655 * hotplug subsystem previously with a call to pci_hp_register().
656 *
657 * Returns 0 if successful, anything else for an error.
658 */
659 int __must_check pci_hp_change_slot_info(struct hotplug_slot *hotplug,
660 struct hotplug_slot_info *info)
661 {
662 struct pci_slot *slot;
663 if (!hotplug || !info)
664 return -ENODEV;
665 slot = hotplug->pci_slot;
666
667 memcpy(hotplug->info, info, sizeof(struct hotplug_slot_info));
668
669 return 0;
670 }
671
672 static int __init pci_hotplug_init (void)
673 {
674 int result;
675
676 result = cpci_hotplug_init(debug);
677 if (result) {
678 err ("cpci_hotplug_init with error %d\n", result);
679 goto err_cpci;
680 }
681
682 info (DRIVER_DESC " version: " DRIVER_VERSION "\n");
683
684 err_cpci:
685 return result;
686 }
687
688 static void __exit pci_hotplug_exit (void)
689 {
690 cpci_hotplug_exit();
691 }
692
693 module_init(pci_hotplug_init);
694 module_exit(pci_hotplug_exit);
695
696 MODULE_AUTHOR(DRIVER_AUTHOR);
697 MODULE_DESCRIPTION(DRIVER_DESC);
698 MODULE_LICENSE("GPL");
699 module_param(debug, bool, 0644);
700 MODULE_PARM_DESC(debug, "Debugging mode enabled or not");
701
702 EXPORT_SYMBOL_GPL(__pci_hp_register);
703 EXPORT_SYMBOL_GPL(pci_hp_deregister);
704 EXPORT_SYMBOL_GPL(pci_hp_change_slot_info);