Commit | Line | Data |
---|---|---|
01b57e73 KCA |
1 | /* |
2 | * bay.c - ACPI removable drive bay driver | |
3 | * | |
4 | * Copyright (C) 2006 Kristen Carlson Accardi <kristen.c.accardi@intel.com> | |
5 | * | |
6 | * ~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~ | |
7 | * | |
8 | * This program is free software; you can redistribute it and/or modify | |
9 | * it under the terms of the GNU General Public License as published by | |
10 | * the Free Software Foundation; either version 2 of the License, or (at | |
11 | * your option) any later version. | |
12 | * | |
13 | * This program is distributed in the hope that it will be useful, but | |
14 | * WITHOUT ANY WARRANTY; without even the implied warranty of | |
15 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU | |
16 | * General Public License for more details. | |
17 | * | |
18 | * You should have received a copy of the GNU General Public License along | |
19 | * with this program; if not, write to the Free Software Foundation, Inc., | |
20 | * 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA. | |
21 | * | |
22 | * ~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~ | |
23 | */ | |
24 | #include <linux/kernel.h> | |
25 | #include <linux/module.h> | |
26 | #include <linux/init.h> | |
27 | #include <linux/types.h> | |
28 | #include <linux/notifier.h> | |
29 | #include <acpi/acpi_bus.h> | |
30 | #include <acpi/acpi_drivers.h> | |
01b57e73 KCA |
31 | #include <linux/seq_file.h> |
32 | #include <asm/uaccess.h> | |
2b167c01 | 33 | #include <linux/platform_device.h> |
01b57e73 | 34 | |
f52fd66d | 35 | ACPI_MODULE_NAME("bay"); |
01b57e73 | 36 | MODULE_AUTHOR("Kristen Carlson Accardi"); |
7cda93e0 | 37 | MODULE_DESCRIPTION("ACPI Removable Drive Bay Driver"); |
01b57e73 KCA |
38 | MODULE_LICENSE("GPL"); |
39 | #define ACPI_BAY_CLASS "bay" | |
40 | #define ACPI_BAY_COMPONENT 0x10000000 | |
41 | #define _COMPONENT ACPI_BAY_COMPONENT | |
42 | #define bay_dprintk(h,s) {\ | |
43 | char prefix[80] = {'\0'};\ | |
44 | struct acpi_buffer buffer = {sizeof(prefix), prefix};\ | |
45 | acpi_get_name(h, ACPI_FULL_PATHNAME, &buffer);\ | |
46 | printk(KERN_DEBUG PREFIX "%s: %s\n", prefix, s); } | |
01b57e73 | 47 | static void bay_notify(acpi_handle handle, u32 event, void *data); |
01b57e73 | 48 | |
17196d6e TR |
49 | static const struct acpi_device_id bay_device_ids[] = { |
50 | {"LNXIOBAY", 0}, | |
51 | {"", 0}, | |
52 | }; | |
53 | MODULE_DEVICE_TABLE(acpi, bay_device_ids); | |
54 | ||
01b57e73 KCA |
55 | struct bay { |
56 | acpi_handle handle; | |
57 | char *name; | |
58 | struct list_head list; | |
2b167c01 | 59 | struct platform_device *pdev; |
01b57e73 KCA |
60 | }; |
61 | ||
5d22e1e8 | 62 | static LIST_HEAD(drive_bays); |
01b57e73 | 63 | |
01b57e73 KCA |
64 | |
65 | /***************************************************************************** | |
66 | * Drive Bay functions * | |
67 | *****************************************************************************/ | |
68 | /** | |
69 | * is_ejectable - see if a device is ejectable | |
70 | * @handle: acpi handle of the device | |
71 | * | |
72 | * If an acpi object has a _EJ0 method, then it is ejectable | |
73 | */ | |
74 | static int is_ejectable(acpi_handle handle) | |
75 | { | |
76 | acpi_status status; | |
77 | acpi_handle tmp; | |
78 | ||
79 | status = acpi_get_handle(handle, "_EJ0", &tmp); | |
80 | if (ACPI_FAILURE(status)) | |
81 | return 0; | |
82 | return 1; | |
83 | } | |
84 | ||
85 | /** | |
86 | * bay_present - see if the bay device is present | |
87 | * @bay: the drive bay | |
88 | * | |
89 | * execute the _STA method. | |
90 | */ | |
91 | static int bay_present(struct bay *bay) | |
92 | { | |
93 | unsigned long sta; | |
94 | acpi_status status; | |
95 | ||
96 | if (bay) { | |
97 | status = acpi_evaluate_integer(bay->handle, "_STA", NULL, &sta); | |
98 | if (ACPI_SUCCESS(status) && sta) | |
99 | return 1; | |
100 | } | |
101 | return 0; | |
102 | } | |
103 | ||
104 | /** | |
105 | * eject_device - respond to an eject request | |
106 | * @handle - the device to eject | |
107 | * | |
108 | * Call this devices _EJ0 method. | |
109 | */ | |
110 | static void eject_device(acpi_handle handle) | |
111 | { | |
112 | struct acpi_object_list arg_list; | |
113 | union acpi_object arg; | |
114 | ||
115 | bay_dprintk(handle, "Ejecting device"); | |
116 | ||
117 | arg_list.count = 1; | |
118 | arg_list.pointer = &arg; | |
119 | arg.type = ACPI_TYPE_INTEGER; | |
120 | arg.integer.value = 1; | |
121 | ||
122 | if (ACPI_FAILURE(acpi_evaluate_object(handle, "_EJ0", | |
123 | &arg_list, NULL))) | |
124 | pr_debug("Failed to evaluate _EJ0!\n"); | |
125 | } | |
126 | ||
2b167c01 KCA |
127 | /* |
128 | * show_present - read method for "present" file in sysfs | |
129 | */ | |
130 | static ssize_t show_present(struct device *dev, | |
131 | struct device_attribute *attr, char *buf) | |
132 | { | |
133 | struct bay *bay = dev_get_drvdata(dev); | |
134 | return snprintf(buf, PAGE_SIZE, "%d\n", bay_present(bay)); | |
135 | ||
136 | } | |
e5685b9d | 137 | static DEVICE_ATTR(present, S_IRUGO, show_present, NULL); |
2b167c01 KCA |
138 | |
139 | /* | |
140 | * write_eject - write method for "eject" file in sysfs | |
141 | */ | |
142 | static ssize_t write_eject(struct device *dev, struct device_attribute *attr, | |
143 | const char *buf, size_t count) | |
144 | { | |
145 | struct bay *bay = dev_get_drvdata(dev); | |
146 | ||
147 | if (!count) | |
148 | return -EINVAL; | |
149 | ||
150 | eject_device(bay->handle); | |
151 | return count; | |
152 | } | |
e5685b9d | 153 | static DEVICE_ATTR(eject, S_IWUSR, NULL, write_eject); |
01b57e73 KCA |
154 | |
155 | /** | |
156 | * is_ata - see if a device is an ata device | |
157 | * @handle: acpi handle of the device | |
158 | * | |
159 | * If an acpi object has one of 4 ATA ACPI methods defined, | |
160 | * then it is an ATA device | |
161 | */ | |
162 | static int is_ata(acpi_handle handle) | |
163 | { | |
164 | acpi_handle tmp; | |
165 | ||
166 | if ((ACPI_SUCCESS(acpi_get_handle(handle, "_GTF", &tmp))) || | |
167 | (ACPI_SUCCESS(acpi_get_handle(handle, "_GTM", &tmp))) || | |
168 | (ACPI_SUCCESS(acpi_get_handle(handle, "_STM", &tmp))) || | |
169 | (ACPI_SUCCESS(acpi_get_handle(handle, "_SDD", &tmp)))) | |
170 | return 1; | |
171 | ||
172 | return 0; | |
173 | } | |
174 | ||
175 | /** | |
176 | * parent_is_ata(acpi_handle handle) | |
177 | * | |
178 | */ | |
179 | static int parent_is_ata(acpi_handle handle) | |
180 | { | |
181 | acpi_handle phandle; | |
182 | ||
183 | if (acpi_get_parent(handle, &phandle)) | |
184 | return 0; | |
185 | ||
186 | return is_ata(phandle); | |
187 | } | |
188 | ||
189 | /** | |
190 | * is_ejectable_bay - see if a device is an ejectable drive bay | |
191 | * @handle: acpi handle of the device | |
192 | * | |
193 | * If an acpi object is ejectable and has one of the ACPI ATA | |
194 | * methods defined, then we can safely call it an ejectable | |
195 | * drive bay | |
196 | */ | |
197 | static int is_ejectable_bay(acpi_handle handle) | |
198 | { | |
199 | if ((is_ata(handle) || parent_is_ata(handle)) && is_ejectable(handle)) | |
200 | return 1; | |
201 | return 0; | |
202 | } | |
203 | ||
2a241d77 | 204 | #if 0 |
01b57e73 KCA |
205 | /** |
206 | * eject_removable_drive - try to eject this drive | |
207 | * @dev : the device structure of the drive | |
208 | * | |
209 | * If a device is a removable drive that requires an _EJ0 method | |
210 | * to be executed in order to safely remove from the system, do | |
211 | * it. ATM - always returns success | |
212 | */ | |
213 | int eject_removable_drive(struct device *dev) | |
214 | { | |
215 | acpi_handle handle = DEVICE_ACPI_HANDLE(dev); | |
216 | ||
217 | if (handle) { | |
218 | bay_dprintk(handle, "Got device handle"); | |
219 | if (is_ejectable_bay(handle)) | |
220 | eject_device(handle); | |
221 | } else { | |
222 | printk("No acpi handle for device\n"); | |
223 | } | |
224 | ||
225 | /* should I return an error code? */ | |
226 | return 0; | |
227 | } | |
228 | EXPORT_SYMBOL_GPL(eject_removable_drive); | |
2a241d77 | 229 | #endif /* 0 */ |
01b57e73 | 230 | |
01b57e73 KCA |
231 | static int acpi_bay_add_fs(struct bay *bay) |
232 | { | |
2b167c01 KCA |
233 | int ret; |
234 | struct device *dev = &bay->pdev->dev; | |
235 | ||
236 | ret = device_create_file(dev, &dev_attr_present); | |
237 | if (ret) | |
238 | goto add_fs_err; | |
239 | ret = device_create_file(dev, &dev_attr_eject); | |
240 | if (ret) { | |
241 | device_remove_file(dev, &dev_attr_present); | |
242 | goto add_fs_err; | |
243 | } | |
244 | return 0; | |
245 | ||
246 | add_fs_err: | |
247 | bay_dprintk(bay->handle, "Error adding sysfs files\n"); | |
248 | return ret; | |
01b57e73 KCA |
249 | } |
250 | ||
251 | static void acpi_bay_remove_fs(struct bay *bay) | |
252 | { | |
2b167c01 KCA |
253 | struct device *dev = &bay->pdev->dev; |
254 | ||
255 | /* cleanup sysfs */ | |
256 | device_remove_file(dev, &dev_attr_present); | |
257 | device_remove_file(dev, &dev_attr_eject); | |
01b57e73 KCA |
258 | } |
259 | ||
260 | static int bay_is_dock_device(acpi_handle handle) | |
261 | { | |
262 | acpi_handle parent; | |
263 | ||
264 | acpi_get_parent(handle, &parent); | |
265 | ||
266 | /* if the device or it's parent is dependent on the | |
267 | * dock, then we are a dock device | |
268 | */ | |
269 | return (is_dock_device(handle) || is_dock_device(parent)); | |
270 | } | |
271 | ||
2b167c01 | 272 | static int bay_add(acpi_handle handle, int id) |
01b57e73 KCA |
273 | { |
274 | acpi_status status; | |
275 | struct bay *new_bay; | |
2b167c01 | 276 | struct platform_device *pdev; |
01b57e73 KCA |
277 | struct acpi_buffer nbuffer = {ACPI_ALLOCATE_BUFFER, NULL}; |
278 | acpi_get_name(handle, ACPI_FULL_PATHNAME, &nbuffer); | |
279 | ||
280 | bay_dprintk(handle, "Adding notify handler"); | |
281 | ||
01b57e73 KCA |
282 | /* |
283 | * Initialize bay device structure | |
284 | */ | |
a3c94e5c | 285 | new_bay = kzalloc(sizeof(*new_bay), GFP_ATOMIC); |
01b57e73 KCA |
286 | INIT_LIST_HEAD(&new_bay->list); |
287 | new_bay->handle = handle; | |
288 | new_bay->name = (char *)nbuffer.pointer; | |
2b167c01 KCA |
289 | |
290 | /* initialize platform device stuff */ | |
291 | pdev = platform_device_register_simple(ACPI_BAY_CLASS, id, NULL, 0); | |
0539771d | 292 | if (IS_ERR(pdev)) { |
2b167c01 KCA |
293 | printk(KERN_ERR PREFIX "Error registering bay device\n"); |
294 | goto bay_add_err; | |
295 | } | |
296 | new_bay->pdev = pdev; | |
297 | platform_set_drvdata(pdev, new_bay); | |
298 | ||
1f9767df KCA |
299 | /* |
300 | * we want the bay driver to be able to send uevents | |
301 | */ | |
302 | pdev->dev.uevent_suppress = 0; | |
303 | ||
01b57e73 KCA |
304 | /* register for events on this device */ |
305 | status = acpi_install_notify_handler(handle, ACPI_SYSTEM_NOTIFY, | |
306 | bay_notify, new_bay); | |
307 | if (ACPI_FAILURE(status)) { | |
7efd52a4 HM |
308 | printk(KERN_INFO PREFIX "Error installing bay notify handler\n"); |
309 | platform_device_unregister(new_bay->pdev); | |
310 | goto bay_add_err; | |
311 | } | |
312 | ||
313 | if (acpi_bay_add_fs(new_bay)) { | |
314 | acpi_remove_notify_handler(handle, ACPI_SYSTEM_NOTIFY, | |
315 | bay_notify); | |
316 | platform_device_unregister(new_bay->pdev); | |
317 | goto bay_add_err; | |
01b57e73 KCA |
318 | } |
319 | ||
320 | /* if we are on a dock station, we should register for dock | |
321 | * notifications. | |
322 | */ | |
323 | if (bay_is_dock_device(handle)) { | |
324 | bay_dprintk(handle, "Is dependent on dock\n"); | |
325 | register_hotplug_dock_device(handle, bay_notify, new_bay); | |
326 | } | |
2b167c01 | 327 | list_add(&new_bay->list, &drive_bays); |
01b57e73 KCA |
328 | printk(KERN_INFO PREFIX "Bay [%s] Added\n", new_bay->name); |
329 | return 0; | |
2b167c01 KCA |
330 | |
331 | bay_add_err: | |
332 | kfree(new_bay->name); | |
333 | kfree(new_bay); | |
334 | return -ENODEV; | |
01b57e73 KCA |
335 | } |
336 | ||
01b57e73 KCA |
337 | /** |
338 | * bay_notify - act upon an acpi bay notification | |
339 | * @handle: the bay handle | |
340 | * @event: the acpi event | |
341 | * @data: our driver data struct | |
342 | * | |
343 | */ | |
344 | static void bay_notify(acpi_handle handle, u32 event, void *data) | |
345 | { | |
c41458ac KCA |
346 | struct bay *bay_dev = (struct bay *)data; |
347 | struct device *dev = &bay_dev->pdev->dev; | |
3f8698d4 KCA |
348 | char event_string[12]; |
349 | char *envp[] = { event_string, NULL }; | |
01b57e73 KCA |
350 | |
351 | bay_dprintk(handle, "Bay event"); | |
7aa763cb | 352 | sprintf(event_string, "BAY_EVENT=%d", event); |
3f8698d4 | 353 | kobject_uevent_env(&dev->kobj, KOBJ_CHANGE, envp); |
01b57e73 KCA |
354 | } |
355 | ||
356 | static acpi_status | |
357 | find_bay(acpi_handle handle, u32 lvl, void *context, void **rv) | |
358 | { | |
359 | int *count = (int *)context; | |
360 | ||
361 | /* | |
362 | * there could be more than one ejectable bay. | |
363 | * so, just return AE_OK always so that every object | |
364 | * will be checked. | |
365 | */ | |
366 | if (is_ejectable_bay(handle)) { | |
367 | bay_dprintk(handle, "found ejectable bay"); | |
2b167c01 KCA |
368 | if (!bay_add(handle, *count)) |
369 | (*count)++; | |
01b57e73 KCA |
370 | } |
371 | return AE_OK; | |
372 | } | |
373 | ||
374 | static int __init bay_init(void) | |
375 | { | |
376 | int bays = 0; | |
377 | ||
01b57e73 KCA |
378 | INIT_LIST_HEAD(&drive_bays); |
379 | ||
816c2eda LB |
380 | if (acpi_disabled) |
381 | return -ENODEV; | |
382 | ||
01b57e73 KCA |
383 | /* look for dockable drive bays */ |
384 | acpi_walk_namespace(ACPI_TYPE_DEVICE, ACPI_ROOT_OBJECT, | |
385 | ACPI_UINT32_MAX, find_bay, &bays, NULL); | |
386 | ||
01b57e73 KCA |
387 | if (!bays) |
388 | return -ENODEV; | |
389 | ||
390 | return 0; | |
391 | } | |
392 | ||
393 | static void __exit bay_exit(void) | |
394 | { | |
395 | struct bay *bay, *tmp; | |
396 | ||
397 | list_for_each_entry_safe(bay, tmp, &drive_bays, list) { | |
398 | if (is_dock_device(bay->handle)) | |
399 | unregister_hotplug_dock_device(bay->handle); | |
400 | acpi_bay_remove_fs(bay); | |
401 | acpi_remove_notify_handler(bay->handle, ACPI_SYSTEM_NOTIFY, | |
402 | bay_notify); | |
2b167c01 | 403 | platform_device_unregister(bay->pdev); |
01b57e73 KCA |
404 | kfree(bay->name); |
405 | kfree(bay); | |
406 | } | |
01b57e73 KCA |
407 | } |
408 | ||
409 | postcore_initcall(bay_init); | |
410 | module_exit(bay_exit); | |
411 |