]>
Commit | Line | Data |
---|---|---|
1da177e4 LT |
1 | /* |
2 | * acpi_container.c - ACPI Generic Container Driver | |
3 | * ($Revision: ) | |
4 | * | |
5 | * Copyright (C) 2004 Anil S Keshavamurthy (anil.s.keshavamurthy@intel.com) | |
6 | * Copyright (C) 2004 Keiichiro Tokunaga (tokunaga.keiich@jp.fujitsu.com) | |
7 | * Copyright (C) 2004 Motoyuki Ito (motoyuki@soft.fujitsu.com) | |
8 | * Copyright (C) 2004 Intel Corp. | |
9 | * Copyright (C) 2004 FUJITSU LIMITED | |
10 | * | |
11 | * ~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~ | |
12 | * | |
13 | * This program is free software; you can redistribute it and/or modify | |
14 | * it under the terms of the GNU General Public License as published by | |
15 | * the Free Software Foundation; either version 2 of the License, or (at | |
16 | * your option) any later version. | |
17 | * | |
18 | * This program is distributed in the hope that it will be useful, but | |
19 | * WITHOUT ANY WARRANTY; without even the implied warranty of | |
20 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU | |
21 | * General Public License for more details. | |
22 | * | |
23 | * You should have received a copy of the GNU General Public License along | |
24 | * with this program; if not, write to the Free Software Foundation, Inc., | |
25 | * 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA. | |
26 | * | |
27 | * ~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~ | |
28 | */ | |
29 | #include <linux/kernel.h> | |
30 | #include <linux/module.h> | |
31 | #include <linux/init.h> | |
5a0e3ad6 | 32 | #include <linux/slab.h> |
1da177e4 LT |
33 | #include <linux/types.h> |
34 | #include <linux/acpi.h> | |
35 | #include <acpi/acpi_bus.h> | |
36 | #include <acpi/acpi_drivers.h> | |
37 | #include <acpi/container.h> | |
38 | ||
a192a958 LB |
39 | #define PREFIX "ACPI: " |
40 | ||
1da177e4 LT |
41 | #define ACPI_CONTAINER_DEVICE_NAME "ACPI container device" |
42 | #define ACPI_CONTAINER_CLASS "container" | |
43 | ||
44 | #define INSTALL_NOTIFY_HANDLER 1 | |
45 | #define UNINSTALL_NOTIFY_HANDLER 2 | |
46 | ||
1da177e4 | 47 | #define _COMPONENT ACPI_CONTAINER_COMPONENT |
f52fd66d | 48 | ACPI_MODULE_NAME("container"); |
1da177e4 | 49 | |
f52fd66d | 50 | MODULE_AUTHOR("Anil S Keshavamurthy"); |
7cda93e0 | 51 | MODULE_DESCRIPTION("ACPI container driver"); |
1da177e4 LT |
52 | MODULE_LICENSE("GPL"); |
53 | ||
1da177e4 | 54 | static int acpi_container_add(struct acpi_device *device); |
51fac838 | 55 | static int acpi_container_remove(struct acpi_device *device); |
1da177e4 | 56 | |
1ba90e3a TR |
57 | static const struct acpi_device_id container_device_ids[] = { |
58 | {"ACPI0004", 0}, | |
59 | {"PNP0A05", 0}, | |
60 | {"PNP0A06", 0}, | |
61 | {"", 0}, | |
62 | }; | |
63 | MODULE_DEVICE_TABLE(acpi, container_device_ids); | |
64 | ||
1da177e4 | 65 | static struct acpi_driver acpi_container_driver = { |
c2b6705b | 66 | .name = "container", |
4be44fcd | 67 | .class = ACPI_CONTAINER_CLASS, |
1ba90e3a | 68 | .ids = container_device_ids, |
4be44fcd LB |
69 | .ops = { |
70 | .add = acpi_container_add, | |
71 | .remove = acpi_container_remove, | |
72 | }, | |
1da177e4 LT |
73 | }; |
74 | ||
1da177e4 LT |
75 | /*******************************************************************/ |
76 | ||
4be44fcd | 77 | static int is_device_present(acpi_handle handle) |
1da177e4 | 78 | { |
4be44fcd LB |
79 | acpi_handle temp; |
80 | acpi_status status; | |
27663c58 | 81 | unsigned long long sta; |
1da177e4 | 82 | |
1da177e4 LT |
83 | |
84 | status = acpi_get_handle(handle, "_STA", &temp); | |
85 | if (ACPI_FAILURE(status)) | |
a0bd4ac4 | 86 | return 1; /* _STA not found, assume device present */ |
1da177e4 LT |
87 | |
88 | status = acpi_evaluate_integer(handle, "_STA", NULL, &sta); | |
89 | if (ACPI_FAILURE(status)) | |
d550d98d | 90 | return 0; /* Firmware error */ |
1da177e4 | 91 | |
a0bd4ac4 | 92 | return ((sta & ACPI_STA_DEVICE_PRESENT) == ACPI_STA_DEVICE_PRESENT); |
1da177e4 LT |
93 | } |
94 | ||
594df89a TC |
95 | static bool is_container_device(const char *hid) |
96 | { | |
97 | const struct acpi_device_id *container_id; | |
98 | ||
99 | for (container_id = container_device_ids; | |
100 | container_id->id[0]; container_id++) { | |
101 | if (!strcmp((char *)container_id->id, hid)) | |
102 | return true; | |
103 | } | |
104 | ||
105 | return false; | |
106 | } | |
107 | ||
1da177e4 | 108 | /*******************************************************************/ |
4be44fcd | 109 | static int acpi_container_add(struct acpi_device *device) |
1da177e4 LT |
110 | { |
111 | struct acpi_container *container; | |
112 | ||
36bcbec7 | 113 | container = kzalloc(sizeof(struct acpi_container), GFP_KERNEL); |
4be44fcd | 114 | if (!container) |
d550d98d | 115 | return -ENOMEM; |
4be44fcd | 116 | |
1da177e4 LT |
117 | container->handle = device->handle; |
118 | strcpy(acpi_device_name(device), ACPI_CONTAINER_DEVICE_NAME); | |
119 | strcpy(acpi_device_class(device), ACPI_CONTAINER_CLASS); | |
db89b4f0 | 120 | device->driver_data = container; |
1da177e4 | 121 | |
4be44fcd LB |
122 | ACPI_DEBUG_PRINT((ACPI_DB_INFO, "Device <%s> bid <%s>\n", |
123 | acpi_device_name(device), acpi_device_bid(device))); | |
1da177e4 | 124 | |
d550d98d | 125 | return 0; |
1da177e4 LT |
126 | } |
127 | ||
51fac838 | 128 | static int acpi_container_remove(struct acpi_device *device) |
1da177e4 | 129 | { |
4be44fcd LB |
130 | acpi_status status = AE_OK; |
131 | struct acpi_container *pc = NULL; | |
1da177e4 | 132 | |
50dd0969 | 133 | pc = acpi_driver_data(device); |
6044ec88 | 134 | kfree(pc); |
1da177e4 LT |
135 | return status; |
136 | } | |
137 | ||
4be44fcd | 138 | static void container_notify_cb(acpi_handle handle, u32 type, void *context) |
1da177e4 | 139 | { |
4be44fcd | 140 | struct acpi_device *device = NULL; |
1da177e4 LT |
141 | int result; |
142 | int present; | |
143 | acpi_status status; | |
0c67dc24 | 144 | u32 ost_code = ACPI_OST_SC_NON_SPECIFIC_FAILURE; /* default */ |
4be44fcd | 145 | |
1da177e4 LT |
146 | switch (type) { |
147 | case ACPI_NOTIFY_BUS_CHECK: | |
148 | /* Fall through */ | |
149 | case ACPI_NOTIFY_DEVICE_CHECK: | |
3d78bd9e | 150 | pr_debug("Container driver received %s event\n", |
4be44fcd LB |
151 | (type == ACPI_NOTIFY_BUS_CHECK) ? |
152 | "ACPI_NOTIFY_BUS_CHECK" : "ACPI_NOTIFY_DEVICE_CHECK"); | |
0c67dc24 TK |
153 | |
154 | present = is_device_present(handle); | |
1da177e4 | 155 | status = acpi_bus_get_device(handle, &device); |
0c67dc24 | 156 | if (!present) { |
1da177e4 LT |
157 | if (ACPI_SUCCESS(status)) { |
158 | /* device exist and this is a remove request */ | |
0c67dc24 | 159 | device->flags.eject_pending = 1; |
f883d9db | 160 | kobject_uevent(&device->dev.kobj, KOBJ_OFFLINE); |
0c67dc24 | 161 | return; |
1da177e4 | 162 | } |
0c67dc24 TK |
163 | break; |
164 | } | |
165 | ||
166 | if (!ACPI_FAILURE(status) || device) | |
167 | break; | |
168 | ||
b8bd759a | 169 | result = acpi_bus_scan(handle); |
0c67dc24 | 170 | if (result) { |
3d78bd9e | 171 | acpi_handle_warn(handle, "Failed to add container\n"); |
0c67dc24 | 172 | break; |
1da177e4 | 173 | } |
0cd6ac52 RW |
174 | result = acpi_bus_get_device(handle, &device); |
175 | if (result) { | |
176 | acpi_handle_warn(handle, "Missing device object\n"); | |
177 | break; | |
178 | } | |
0c67dc24 TK |
179 | |
180 | kobject_uevent(&device->dev.kobj, KOBJ_ONLINE); | |
181 | ost_code = ACPI_OST_SC_SUCCESS; | |
1da177e4 | 182 | break; |
0c67dc24 | 183 | |
1da177e4 LT |
184 | case ACPI_NOTIFY_EJECT_REQUEST: |
185 | if (!acpi_bus_get_device(handle, &device) && device) { | |
0c67dc24 | 186 | device->flags.eject_pending = 1; |
f883d9db | 187 | kobject_uevent(&device->dev.kobj, KOBJ_OFFLINE); |
0c67dc24 | 188 | return; |
1da177e4 LT |
189 | } |
190 | break; | |
0c67dc24 | 191 | |
1da177e4 | 192 | default: |
0c67dc24 TK |
193 | /* non-hotplug event; possibly handled by other handler */ |
194 | return; | |
1da177e4 | 195 | } |
0c67dc24 TK |
196 | |
197 | /* Inform firmware that the hotplug operation has completed */ | |
198 | (void) acpi_evaluate_hotplug_ost(handle, type, ost_code, NULL); | |
d550d98d | 199 | return; |
1da177e4 LT |
200 | } |
201 | ||
202 | static acpi_status | |
203 | container_walk_namespace_cb(acpi_handle handle, | |
4be44fcd | 204 | u32 lvl, void *context, void **rv) |
1da177e4 | 205 | { |
4be44fcd | 206 | char *hid = NULL; |
4be44fcd LB |
207 | struct acpi_device_info *info; |
208 | acpi_status status; | |
209 | int *action = context; | |
1da177e4 | 210 | |
15b8dd53 BM |
211 | status = acpi_get_object_info(handle, &info); |
212 | if (ACPI_FAILURE(status)) { | |
d550d98d | 213 | return AE_OK; |
1da177e4 LT |
214 | } |
215 | ||
1da177e4 | 216 | if (info->valid & ACPI_VALID_HID) |
15b8dd53 | 217 | hid = info->hardware_id.string; |
1da177e4 LT |
218 | |
219 | if (hid == NULL) { | |
220 | goto end; | |
221 | } | |
222 | ||
594df89a | 223 | if (!is_container_device(hid)) |
1da177e4 | 224 | goto end; |
1da177e4 | 225 | |
4be44fcd | 226 | switch (*action) { |
1da177e4 LT |
227 | case INSTALL_NOTIFY_HANDLER: |
228 | acpi_install_notify_handler(handle, | |
4be44fcd LB |
229 | ACPI_SYSTEM_NOTIFY, |
230 | container_notify_cb, NULL); | |
1da177e4 LT |
231 | break; |
232 | case UNINSTALL_NOTIFY_HANDLER: | |
233 | acpi_remove_notify_handler(handle, | |
4be44fcd LB |
234 | ACPI_SYSTEM_NOTIFY, |
235 | container_notify_cb); | |
1da177e4 LT |
236 | break; |
237 | default: | |
238 | break; | |
239 | } | |
240 | ||
4be44fcd | 241 | end: |
15b8dd53 | 242 | kfree(info); |
1da177e4 | 243 | |
d550d98d | 244 | return AE_OK; |
1da177e4 LT |
245 | } |
246 | ||
4be44fcd | 247 | static int __init acpi_container_init(void) |
1da177e4 | 248 | { |
4be44fcd LB |
249 | int result = 0; |
250 | int action = INSTALL_NOTIFY_HANDLER; | |
1da177e4 LT |
251 | |
252 | result = acpi_bus_register_driver(&acpi_container_driver); | |
253 | if (result < 0) { | |
4be44fcd | 254 | return (result); |
1da177e4 LT |
255 | } |
256 | ||
257 | /* register notify handler to every container device */ | |
258 | acpi_walk_namespace(ACPI_TYPE_DEVICE, | |
4be44fcd LB |
259 | ACPI_ROOT_OBJECT, |
260 | ACPI_UINT32_MAX, | |
2263576c | 261 | container_walk_namespace_cb, NULL, &action, NULL); |
1da177e4 | 262 | |
4be44fcd | 263 | return (0); |
1da177e4 LT |
264 | } |
265 | ||
4be44fcd | 266 | static void __exit acpi_container_exit(void) |
1da177e4 | 267 | { |
4be44fcd | 268 | int action = UNINSTALL_NOTIFY_HANDLER; |
1da177e4 | 269 | |
1da177e4 LT |
270 | |
271 | acpi_walk_namespace(ACPI_TYPE_DEVICE, | |
4be44fcd LB |
272 | ACPI_ROOT_OBJECT, |
273 | ACPI_UINT32_MAX, | |
2263576c | 274 | container_walk_namespace_cb, NULL, &action, NULL); |
1da177e4 LT |
275 | |
276 | acpi_bus_unregister_driver(&acpi_container_driver); | |
277 | ||
d550d98d | 278 | return; |
1da177e4 LT |
279 | } |
280 | ||
281 | module_init(acpi_container_init); | |
282 | module_exit(acpi_container_exit); |