Commit | Line | Data |
---|---|---|
83dbf66f TP |
1 | /* Works like the fakephp driver used to, except a little better. |
2 | * | |
3 | * - It's possible to remove devices with subordinate busses. | |
4 | * - New PCI devices that appear via any method, not just a fakephp triggered | |
5 | * rescan, will be noticed. | |
6 | * - Devices that are removed via any method, not just a fakephp triggered | |
7 | * removal, will also be noticed. | |
8 | * | |
9 | * Uses nothing from the pci-hotplug subsystem. | |
10 | * | |
11 | */ | |
12 | ||
13 | #include <linux/module.h> | |
14 | #include <linux/kernel.h> | |
15 | #include <linux/types.h> | |
16 | #include <linux/list.h> | |
17 | #include <linux/kobject.h> | |
18 | #include <linux/sysfs.h> | |
19 | #include <linux/init.h> | |
20 | #include <linux/pci.h> | |
7bb2cb3e | 21 | #include <linux/device.h> |
83dbf66f TP |
22 | #include "../pci.h" |
23 | ||
24 | struct legacy_slot { | |
25 | struct kobject kobj; | |
26 | struct pci_dev *dev; | |
27 | struct list_head list; | |
28 | }; | |
29 | ||
30 | static LIST_HEAD(legacy_list); | |
31 | ||
32 | static ssize_t legacy_show(struct kobject *kobj, struct attribute *attr, | |
33 | char *buf) | |
34 | { | |
35 | struct legacy_slot *slot = container_of(kobj, typeof(*slot), kobj); | |
36 | strcpy(buf, "1\n"); | |
37 | return 2; | |
38 | } | |
39 | ||
40 | static void remove_callback(void *data) | |
41 | { | |
42 | pci_remove_bus_device((struct pci_dev *)data); | |
43 | } | |
44 | ||
45 | static ssize_t legacy_store(struct kobject *kobj, struct attribute *attr, | |
46 | const char *buf, size_t len) | |
47 | { | |
48 | struct legacy_slot *slot = container_of(kobj, typeof(*slot), kobj); | |
49 | unsigned long val; | |
50 | ||
51 | if (strict_strtoul(buf, 0, &val) < 0) | |
52 | return -EINVAL; | |
53 | ||
54 | if (val) | |
55 | pci_rescan_bus(slot->dev->bus); | |
56 | else | |
57 | sysfs_schedule_callback(&slot->dev->dev.kobj, remove_callback, | |
58 | slot->dev, THIS_MODULE); | |
59 | return len; | |
60 | } | |
61 | ||
62 | static struct attribute *legacy_attrs[] = { | |
63 | &(struct attribute){ .name = "power", .mode = 0644 }, | |
64 | NULL, | |
65 | }; | |
66 | ||
67 | static void legacy_release(struct kobject *kobj) | |
68 | { | |
69 | struct legacy_slot *slot = container_of(kobj, typeof(*slot), kobj); | |
70 | ||
71 | pci_dev_put(slot->dev); | |
72 | kfree(slot); | |
73 | } | |
74 | ||
75 | static struct kobj_type legacy_ktype = { | |
52cf25d0 | 76 | .sysfs_ops = &(const struct sysfs_ops){ |
83dbf66f TP |
77 | .store = legacy_store, .show = legacy_show |
78 | }, | |
79 | .release = &legacy_release, | |
80 | .default_attrs = legacy_attrs, | |
81 | }; | |
82 | ||
83 | static int legacy_add_slot(struct pci_dev *pdev) | |
84 | { | |
85 | struct legacy_slot *slot = kzalloc(sizeof(*slot), GFP_KERNEL); | |
86 | ||
87 | if (!slot) | |
88 | return -ENOMEM; | |
89 | ||
90 | if (kobject_init_and_add(&slot->kobj, &legacy_ktype, | |
91 | &pci_slots_kset->kobj, "%s", | |
7bb2cb3e | 92 | dev_name(&pdev->dev))) { |
83dbf66f TP |
93 | dev_warn(&pdev->dev, "Failed to created legacy fake slot\n"); |
94 | return -EINVAL; | |
95 | } | |
96 | slot->dev = pci_dev_get(pdev); | |
97 | ||
98 | list_add(&slot->list, &legacy_list); | |
99 | ||
100 | return 0; | |
101 | } | |
102 | ||
103 | static int legacy_notify(struct notifier_block *nb, | |
104 | unsigned long action, void *data) | |
105 | { | |
106 | struct pci_dev *pdev = to_pci_dev(data); | |
107 | ||
108 | if (action == BUS_NOTIFY_ADD_DEVICE) { | |
109 | legacy_add_slot(pdev); | |
110 | } else if (action == BUS_NOTIFY_DEL_DEVICE) { | |
111 | struct legacy_slot *slot; | |
112 | ||
113 | list_for_each_entry(slot, &legacy_list, list) | |
114 | if (slot->dev == pdev) | |
115 | goto found; | |
116 | ||
117 | dev_warn(&pdev->dev, "Missing legacy fake slot?"); | |
118 | return -ENODEV; | |
119 | found: | |
120 | kobject_del(&slot->kobj); | |
121 | list_del(&slot->list); | |
122 | kobject_put(&slot->kobj); | |
123 | } | |
124 | ||
125 | return 0; | |
126 | } | |
127 | ||
128 | static struct notifier_block legacy_notifier = { | |
129 | .notifier_call = legacy_notify | |
130 | }; | |
131 | ||
132 | static int __init init_legacy(void) | |
133 | { | |
134 | struct pci_dev *pdev = NULL; | |
135 | ||
136 | /* Add existing devices */ | |
137 | while ((pdev = pci_get_device(PCI_ANY_ID, PCI_ANY_ID, pdev))) | |
138 | legacy_add_slot(pdev); | |
139 | ||
140 | /* Be alerted of any new ones */ | |
141 | bus_register_notifier(&pci_bus_type, &legacy_notifier); | |
142 | return 0; | |
143 | } | |
144 | module_init(init_legacy); | |
145 | ||
146 | static void __exit remove_legacy(void) | |
147 | { | |
148 | struct legacy_slot *slot, *tmp; | |
149 | ||
150 | bus_unregister_notifier(&pci_bus_type, &legacy_notifier); | |
151 | ||
152 | list_for_each_entry_safe(slot, tmp, &legacy_list, list) { | |
153 | list_del(&slot->list); | |
154 | kobject_del(&slot->kobj); | |
155 | kobject_put(&slot->kobj); | |
156 | } | |
157 | } | |
158 | module_exit(remove_legacy); | |
159 | ||
160 | ||
161 | MODULE_AUTHOR("Trent Piepho <xyzzy@speakeasy.org>"); | |
162 | MODULE_DESCRIPTION("Legacy version of the fakephp interface"); | |
163 | MODULE_LICENSE("GPL"); |