]> pilppa.org Git - linux-2.6-omap-h63xx.git/blob - drivers/acpi/dock.c
ACPI: fix hotplug race
[linux-2.6-omap-h63xx.git] / drivers / acpi / dock.c
1 /*
2  *  dock.c - ACPI dock station 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
25 #include <linux/kernel.h>
26 #include <linux/module.h>
27 #include <linux/init.h>
28 #include <linux/types.h>
29 #include <linux/notifier.h>
30 #include <linux/platform_device.h>
31 #include <linux/jiffies.h>
32 #include <linux/stddef.h>
33 #include <acpi/acpi_bus.h>
34 #include <acpi/acpi_drivers.h>
35
36 #define ACPI_DOCK_DRIVER_DESCRIPTION "ACPI Dock Station Driver"
37
38 ACPI_MODULE_NAME("dock");
39 MODULE_AUTHOR("Kristen Carlson Accardi");
40 MODULE_DESCRIPTION(ACPI_DOCK_DRIVER_DESCRIPTION);
41 MODULE_LICENSE("GPL");
42
43 static int immediate_undock = 1;
44 module_param(immediate_undock, bool, 0644);
45 MODULE_PARM_DESC(immediate_undock, "1 (default) will cause the driver to "
46         "undock immediately when the undock button is pressed, 0 will cause"
47         " the driver to wait for userspace to write the undock sysfs file "
48         " before undocking");
49
50 static struct atomic_notifier_head dock_notifier_list;
51 static char dock_device_name[] = "dock";
52
53 static const struct acpi_device_id dock_device_ids[] = {
54         {"LNXDOCK", 0},
55         {"", 0},
56 };
57 MODULE_DEVICE_TABLE(acpi, dock_device_ids);
58
59 struct dock_station {
60         acpi_handle handle;
61         unsigned long last_dock_time;
62         u32 flags;
63         spinlock_t dd_lock;
64         struct mutex hp_lock;
65         struct list_head dependent_devices;
66         struct list_head hotplug_devices;
67
68         struct list_head sibiling;
69         struct platform_device *dock_device;
70 };
71 static LIST_HEAD(dock_stations);
72 static int dock_station_count;
73
74 struct dock_dependent_device {
75         struct list_head list;
76         struct list_head hotplug_list;
77         acpi_handle handle;
78         acpi_notify_handler handler;
79         void *context;
80 };
81
82 #define DOCK_DOCKING    0x00000001
83 #define DOCK_UNDOCKING  0x00000002
84 #define DOCK_IS_DOCK    0x00000010
85 #define DOCK_IS_ATA     0x00000020
86 #define DOCK_IS_BAT     0x00000040
87 #define DOCK_EVENT      3
88 #define UNDOCK_EVENT    2
89
90 /*****************************************************************************
91  *                         Dock Dependent device functions                   *
92  *****************************************************************************/
93 /**
94  *  alloc_dock_dependent_device - allocate and init a dependent device
95  *  @handle: the acpi_handle of the dependent device
96  *
97  *  Allocate memory for a dependent device structure for a device referenced
98  *  by the acpi handle
99  */
100 static struct dock_dependent_device *
101 alloc_dock_dependent_device(acpi_handle handle)
102 {
103         struct dock_dependent_device *dd;
104
105         dd = kzalloc(sizeof(*dd), GFP_KERNEL);
106         if (dd) {
107                 dd->handle = handle;
108                 INIT_LIST_HEAD(&dd->list);
109                 INIT_LIST_HEAD(&dd->hotplug_list);
110         }
111         return dd;
112 }
113
114 /**
115  * add_dock_dependent_device - associate a device with the dock station
116  * @ds: The dock station
117  * @dd: The dependent device
118  *
119  * Add the dependent device to the dock's dependent device list.
120  */
121 static void
122 add_dock_dependent_device(struct dock_station *ds,
123                           struct dock_dependent_device *dd)
124 {
125         spin_lock(&ds->dd_lock);
126         list_add_tail(&dd->list, &ds->dependent_devices);
127         spin_unlock(&ds->dd_lock);
128 }
129
130 /**
131  * dock_add_hotplug_device - associate a hotplug handler with the dock station
132  * @ds: The dock station
133  * @dd: The dependent device struct
134  *
135  * Add the dependent device to the dock's hotplug device list
136  */
137 static void
138 dock_add_hotplug_device(struct dock_station *ds,
139                         struct dock_dependent_device *dd)
140 {
141         mutex_lock(&ds->hp_lock);
142         list_add_tail(&dd->hotplug_list, &ds->hotplug_devices);
143         mutex_unlock(&ds->hp_lock);
144 }
145
146 /**
147  * dock_del_hotplug_device - remove a hotplug handler from the dock station
148  * @ds: The dock station
149  * @dd: the dependent device struct
150  *
151  * Delete the dependent device from the dock's hotplug device list
152  */
153 static void
154 dock_del_hotplug_device(struct dock_station *ds,
155                         struct dock_dependent_device *dd)
156 {
157         mutex_lock(&ds->hp_lock);
158         list_del(&dd->hotplug_list);
159         mutex_unlock(&ds->hp_lock);
160 }
161
162 /**
163  * find_dock_dependent_device - get a device dependent on this dock
164  * @ds: the dock station
165  * @handle: the acpi_handle of the device we want
166  *
167  * iterate over the dependent device list for this dock.  If the
168  * dependent device matches the handle, return.
169  */
170 static struct dock_dependent_device *
171 find_dock_dependent_device(struct dock_station *ds, acpi_handle handle)
172 {
173         struct dock_dependent_device *dd;
174
175         spin_lock(&ds->dd_lock);
176         list_for_each_entry(dd, &ds->dependent_devices, list) {
177                 if (handle == dd->handle) {
178                         spin_unlock(&ds->dd_lock);
179                         return dd;
180                 }
181         }
182         spin_unlock(&ds->dd_lock);
183         return NULL;
184 }
185
186 /*****************************************************************************
187  *                         Dock functions                                    *
188  *****************************************************************************/
189 /**
190  * is_dock - see if a device is a dock station
191  * @handle: acpi handle of the device
192  *
193  * If an acpi object has a _DCK method, then it is by definition a dock
194  * station, so return true.
195  */
196 static int is_dock(acpi_handle handle)
197 {
198         acpi_status status;
199         acpi_handle tmp;
200
201         status = acpi_get_handle(handle, "_DCK", &tmp);
202         if (ACPI_FAILURE(status))
203                 return 0;
204         return 1;
205 }
206
207 static int is_ejectable(acpi_handle handle)
208 {
209         acpi_status status;
210         acpi_handle tmp;
211
212         status = acpi_get_handle(handle, "_EJ0", &tmp);
213         if (ACPI_FAILURE(status))
214                 return 0;
215         return 1;
216 }
217
218 static int is_ata(acpi_handle handle)
219 {
220         acpi_handle tmp;
221
222         if ((ACPI_SUCCESS(acpi_get_handle(handle, "_GTF", &tmp))) ||
223            (ACPI_SUCCESS(acpi_get_handle(handle, "_GTM", &tmp))) ||
224            (ACPI_SUCCESS(acpi_get_handle(handle, "_STM", &tmp))) ||
225            (ACPI_SUCCESS(acpi_get_handle(handle, "_SDD", &tmp))))
226                 return 1;
227
228         return 0;
229 }
230
231 static int is_battery(acpi_handle handle)
232 {
233         struct acpi_device_info *info;
234         struct acpi_buffer buffer = {ACPI_ALLOCATE_BUFFER, NULL};
235         int ret = 1;
236
237         if (!ACPI_SUCCESS(acpi_get_object_info(handle, &buffer)))
238                 return 0;
239         info = buffer.pointer;
240         if (!(info->valid & ACPI_VALID_HID))
241                 ret = 0;
242         else
243                 ret = !strcmp("PNP0C0A", info->hardware_id.value);
244
245         kfree(buffer.pointer);
246         return ret;
247 }
248
249 static int is_ejectable_bay(acpi_handle handle)
250 {
251         acpi_handle phandle;
252         if (!is_ejectable(handle))
253                 return 0;
254         if (is_battery(handle) || is_ata(handle))
255                 return 1;
256         if (!acpi_get_parent(handle, &phandle) && is_ata(phandle))
257                 return 1;
258         return 0;
259 }
260
261 /**
262  * is_dock_device - see if a device is on a dock station
263  * @handle: acpi handle of the device
264  *
265  * If this device is either the dock station itself,
266  * or is a device dependent on the dock station, then it
267  * is a dock device
268  */
269 int is_dock_device(acpi_handle handle)
270 {
271         struct dock_station *dock_station;
272
273         if (!dock_station_count)
274                 return 0;
275
276         if (is_dock(handle))
277                 return 1;
278         list_for_each_entry(dock_station, &dock_stations, sibiling) {
279                 if (find_dock_dependent_device(dock_station, handle))
280                         return 1;
281         }
282
283         return 0;
284 }
285
286 EXPORT_SYMBOL_GPL(is_dock_device);
287
288 /**
289  * dock_present - see if the dock station is present.
290  * @ds: the dock station
291  *
292  * execute the _STA method.  note that present does not
293  * imply that we are docked.
294  */
295 static int dock_present(struct dock_station *ds)
296 {
297         unsigned long sta;
298         acpi_status status;
299
300         if (ds) {
301                 status = acpi_evaluate_integer(ds->handle, "_STA", NULL, &sta);
302                 if (ACPI_SUCCESS(status) && sta)
303                         return 1;
304         }
305         return 0;
306 }
307
308
309
310 /**
311  * dock_create_acpi_device - add new devices to acpi
312  * @handle - handle of the device to add
313  *
314  *  This function will create a new acpi_device for the given
315  *  handle if one does not exist already.  This should cause
316  *  acpi to scan for drivers for the given devices, and call
317  *  matching driver's add routine.
318  *
319  *  Returns a pointer to the acpi_device corresponding to the handle.
320  */
321 static struct acpi_device * dock_create_acpi_device(acpi_handle handle)
322 {
323         struct acpi_device *device = NULL;
324         struct acpi_device *parent_device;
325         acpi_handle parent;
326         int ret;
327
328         if (acpi_bus_get_device(handle, &device)) {
329                 /*
330                  * no device created for this object,
331                  * so we should create one.
332                  */
333                 acpi_get_parent(handle, &parent);
334                 if (acpi_bus_get_device(parent, &parent_device))
335                         parent_device = NULL;
336
337                 ret = acpi_bus_add(&device, parent_device, handle,
338                         ACPI_BUS_TYPE_DEVICE);
339                 if (ret) {
340                         pr_debug("error adding bus, %x\n",
341                                 -ret);
342                         return NULL;
343                 }
344         }
345         return device;
346 }
347
348 /**
349  * dock_remove_acpi_device - remove the acpi_device struct from acpi
350  * @handle - the handle of the device to remove
351  *
352  *  Tell acpi to remove the acpi_device.  This should cause any loaded
353  *  driver to have it's remove routine called.
354  */
355 static void dock_remove_acpi_device(acpi_handle handle)
356 {
357         struct acpi_device *device;
358         int ret;
359
360         if (!acpi_bus_get_device(handle, &device)) {
361                 ret = acpi_bus_trim(device, 1);
362                 if (ret)
363                         pr_debug("error removing bus, %x\n", -ret);
364         }
365 }
366
367
368 /**
369  * hotplug_dock_devices - insert or remove devices on the dock station
370  * @ds: the dock station
371  * @event: either bus check or eject request
372  *
373  * Some devices on the dock station need to have drivers called
374  * to perform hotplug operations after a dock event has occurred.
375  * Traverse the list of dock devices that have registered a
376  * hotplug handler, and call the handler.
377  */
378 static void hotplug_dock_devices(struct dock_station *ds, u32 event)
379 {
380         struct dock_dependent_device *dd;
381
382         mutex_lock(&ds->hp_lock);
383
384         /*
385          * First call driver specific hotplug functions
386          */
387         list_for_each_entry(dd, &ds->hotplug_devices, hotplug_list) {
388                 if (dd->handler)
389                         dd->handler(dd->handle, event, dd->context);
390         }
391
392         /*
393          * Now make sure that an acpi_device is created for each
394          * dependent device, or removed if this is an eject request.
395          * This will cause acpi_drivers to be stopped/started if they
396          * exist
397          */
398         list_for_each_entry(dd, &ds->dependent_devices, list) {
399                 if (event == ACPI_NOTIFY_EJECT_REQUEST)
400                         dock_remove_acpi_device(dd->handle);
401                 else
402                         dock_create_acpi_device(dd->handle);
403         }
404         mutex_unlock(&ds->hp_lock);
405 }
406
407 static void dock_event(struct dock_station *ds, u32 event, int num)
408 {
409         struct device *dev = &ds->dock_device->dev;
410         char event_string[13];
411         char *envp[] = { event_string, NULL };
412
413         if (num == UNDOCK_EVENT)
414                 sprintf(event_string, "EVENT=undock");
415         else
416                 sprintf(event_string, "EVENT=dock");
417
418         /*
419          * Indicate that the status of the dock station has
420          * changed.
421          */
422         kobject_uevent_env(&dev->kobj, KOBJ_CHANGE, envp);
423 }
424
425 /**
426  * eject_dock - respond to a dock eject request
427  * @ds: the dock station
428  *
429  * This is called after _DCK is called, to execute the dock station's
430  * _EJ0 method.
431  */
432 static void eject_dock(struct dock_station *ds)
433 {
434         struct acpi_object_list arg_list;
435         union acpi_object arg;
436         acpi_status status;
437         acpi_handle tmp;
438
439         /* all dock devices should have _EJ0, but check anyway */
440         status = acpi_get_handle(ds->handle, "_EJ0", &tmp);
441         if (ACPI_FAILURE(status)) {
442                 pr_debug("No _EJ0 support for dock device\n");
443                 return;
444         }
445
446         arg_list.count = 1;
447         arg_list.pointer = &arg;
448         arg.type = ACPI_TYPE_INTEGER;
449         arg.integer.value = 1;
450
451         if (ACPI_FAILURE(acpi_evaluate_object(ds->handle, "_EJ0",
452                                               &arg_list, NULL)))
453                 pr_debug("Failed to evaluate _EJ0!\n");
454 }
455
456 /**
457  * handle_dock - handle a dock event
458  * @ds: the dock station
459  * @dock: to dock, or undock - that is the question
460  *
461  * Execute the _DCK method in response to an acpi event
462  */
463 static void handle_dock(struct dock_station *ds, int dock)
464 {
465         acpi_status status;
466         struct acpi_object_list arg_list;
467         union acpi_object arg;
468         struct acpi_buffer buffer = { ACPI_ALLOCATE_BUFFER, NULL };
469         struct acpi_buffer name_buffer = { ACPI_ALLOCATE_BUFFER, NULL };
470
471         acpi_get_name(ds->handle, ACPI_FULL_PATHNAME, &name_buffer);
472
473         printk(KERN_INFO PREFIX "%s - %s\n",
474                 (char *)name_buffer.pointer, dock ? "docking" : "undocking");
475
476         /* _DCK method has one argument */
477         arg_list.count = 1;
478         arg_list.pointer = &arg;
479         arg.type = ACPI_TYPE_INTEGER;
480         arg.integer.value = dock;
481         status = acpi_evaluate_object(ds->handle, "_DCK", &arg_list, &buffer);
482         if (ACPI_FAILURE(status) && status != AE_NOT_FOUND)
483                 printk(KERN_ERR PREFIX "%s - failed to execute _DCK\n",
484                          (char *)name_buffer.pointer);
485         kfree(buffer.pointer);
486         kfree(name_buffer.pointer);
487 }
488
489 static inline void dock(struct dock_station *ds)
490 {
491         handle_dock(ds, 1);
492 }
493
494 static inline void undock(struct dock_station *ds)
495 {
496         handle_dock(ds, 0);
497 }
498
499 static inline void begin_dock(struct dock_station *ds)
500 {
501         ds->flags |= DOCK_DOCKING;
502 }
503
504 static inline void complete_dock(struct dock_station *ds)
505 {
506         ds->flags &= ~(DOCK_DOCKING);
507         ds->last_dock_time = jiffies;
508 }
509
510 static inline void begin_undock(struct dock_station *ds)
511 {
512         ds->flags |= DOCK_UNDOCKING;
513 }
514
515 static inline void complete_undock(struct dock_station *ds)
516 {
517         ds->flags &= ~(DOCK_UNDOCKING);
518 }
519
520 static void dock_lock(struct dock_station *ds, int lock)
521 {
522         struct acpi_object_list arg_list;
523         union acpi_object arg;
524         acpi_status status;
525
526         arg_list.count = 1;
527         arg_list.pointer = &arg;
528         arg.type = ACPI_TYPE_INTEGER;
529         arg.integer.value = !!lock;
530         status = acpi_evaluate_object(ds->handle, "_LCK", &arg_list, NULL);
531         if (ACPI_FAILURE(status) && status != AE_NOT_FOUND) {
532                 if (lock)
533                         printk(KERN_WARNING PREFIX "Locking device failed\n");
534                 else
535                         printk(KERN_WARNING PREFIX "Unlocking device failed\n");
536         }
537 }
538
539 /**
540  * dock_in_progress - see if we are in the middle of handling a dock event
541  * @ds: the dock station
542  *
543  * Sometimes while docking, false dock events can be sent to the driver
544  * because good connections aren't made or some other reason.  Ignore these
545  * if we are in the middle of doing something.
546  */
547 static int dock_in_progress(struct dock_station *ds)
548 {
549         if ((ds->flags & DOCK_DOCKING) ||
550             time_before(jiffies, (ds->last_dock_time + HZ)))
551                 return 1;
552         return 0;
553 }
554
555 /**
556  * register_dock_notifier - add yourself to the dock notifier list
557  * @nb: the callers notifier block
558  *
559  * If a driver wishes to be notified about dock events, they can
560  * use this function to put a notifier block on the dock notifier list.
561  * this notifier call chain will be called after a dock event, but
562  * before hotplugging any new devices.
563  */
564 int register_dock_notifier(struct notifier_block *nb)
565 {
566         if (!dock_station_count)
567                 return -ENODEV;
568
569         return atomic_notifier_chain_register(&dock_notifier_list, nb);
570 }
571
572 EXPORT_SYMBOL_GPL(register_dock_notifier);
573
574 /**
575  * unregister_dock_notifier - remove yourself from the dock notifier list
576  * @nb: the callers notifier block
577  */
578 void unregister_dock_notifier(struct notifier_block *nb)
579 {
580         if (!dock_station_count)
581                 return;
582
583         atomic_notifier_chain_unregister(&dock_notifier_list, nb);
584 }
585
586 EXPORT_SYMBOL_GPL(unregister_dock_notifier);
587
588 /**
589  * register_hotplug_dock_device - register a hotplug function
590  * @handle: the handle of the device
591  * @handler: the acpi_notifier_handler to call after docking
592  * @context: device specific data
593  *
594  * If a driver would like to perform a hotplug operation after a dock
595  * event, they can register an acpi_notifiy_handler to be called by
596  * the dock driver after _DCK is executed.
597  */
598 int
599 register_hotplug_dock_device(acpi_handle handle, acpi_notify_handler handler,
600                              void *context)
601 {
602         struct dock_dependent_device *dd;
603         struct dock_station *dock_station;
604
605         if (!dock_station_count)
606                 return -ENODEV;
607
608         /*
609          * make sure this handle is for a device dependent on the dock,
610          * this would include the dock station itself
611          */
612         list_for_each_entry(dock_station, &dock_stations, sibiling) {
613                 dd = find_dock_dependent_device(dock_station, handle);
614                 if (dd) {
615                         dd->handler = handler;
616                         dd->context = context;
617                         dock_add_hotplug_device(dock_station, dd);
618                         return 0;
619                 }
620         }
621
622         return -EINVAL;
623 }
624
625 EXPORT_SYMBOL_GPL(register_hotplug_dock_device);
626
627 /**
628  * unregister_hotplug_dock_device - remove yourself from the hotplug list
629  * @handle: the acpi handle of the device
630  */
631 void unregister_hotplug_dock_device(acpi_handle handle)
632 {
633         struct dock_dependent_device *dd;
634         struct dock_station *dock_station;
635
636         if (!dock_station_count)
637                 return;
638
639         list_for_each_entry(dock_station, &dock_stations, sibiling) {
640                 dd = find_dock_dependent_device(dock_station, handle);
641                 if (dd)
642                         dock_del_hotplug_device(dock_station, dd);
643         }
644 }
645
646 EXPORT_SYMBOL_GPL(unregister_hotplug_dock_device);
647
648 /**
649  * handle_eject_request - handle an undock request checking for error conditions
650  *
651  * Check to make sure the dock device is still present, then undock and
652  * hotremove all the devices that may need removing.
653  */
654 static int handle_eject_request(struct dock_station *ds, u32 event)
655 {
656         if (dock_in_progress(ds))
657                 return -EBUSY;
658
659         /*
660          * here we need to generate the undock
661          * event prior to actually doing the undock
662          * so that the device struct still exists.
663          * Also, even send the dock event if the
664          * device is not present anymore
665          */
666         dock_event(ds, event, UNDOCK_EVENT);
667
668         hotplug_dock_devices(ds, ACPI_NOTIFY_EJECT_REQUEST);
669         undock(ds);
670         dock_lock(ds, 0);
671         eject_dock(ds);
672         if (dock_present(ds)) {
673                 printk(KERN_ERR PREFIX "Unable to undock!\n");
674                 return -EBUSY;
675         }
676         complete_undock(ds);
677         return 0;
678 }
679
680 /**
681  * dock_notify - act upon an acpi dock notification
682  * @handle: the dock station handle
683  * @event: the acpi event
684  * @data: our driver data struct
685  *
686  * If we are notified to dock, then check to see if the dock is
687  * present and then dock.  Notify all drivers of the dock event,
688  * and then hotplug and devices that may need hotplugging.
689  */
690 static void dock_notify(acpi_handle handle, u32 event, void *data)
691 {
692         struct dock_station *ds = data;
693         struct acpi_device *tmp;
694         int surprise_removal = 0;
695
696         /*
697          * According to acpi spec 3.0a, if a DEVICE_CHECK notification
698          * is sent and _DCK is present, it is assumed to mean an undock
699          * request.
700          */
701         if ((ds->flags & DOCK_IS_DOCK) && event == ACPI_NOTIFY_DEVICE_CHECK)
702                 event = ACPI_NOTIFY_EJECT_REQUEST;
703
704         /*
705          * dock station: BUS_CHECK - docked or surprise removal
706          *               DEVICE_CHECK - undocked
707          * other device: BUS_CHECK/DEVICE_CHECK - added or surprise removal
708          *
709          * To simplify event handling, dock dependent device handler always
710          * get ACPI_NOTIFY_BUS_CHECK/ACPI_NOTIFY_DEVICE_CHECK for add and
711          * ACPI_NOTIFY_EJECT_REQUEST for removal
712          */
713         switch (event) {
714         case ACPI_NOTIFY_BUS_CHECK:
715         case ACPI_NOTIFY_DEVICE_CHECK:
716                 if (!dock_in_progress(ds) && acpi_bus_get_device(ds->handle,
717                    &tmp)) {
718                         begin_dock(ds);
719                         dock(ds);
720                         if (!dock_present(ds)) {
721                                 printk(KERN_ERR PREFIX "Unable to dock!\n");
722                                 complete_dock(ds);
723                                 break;
724                         }
725                         atomic_notifier_call_chain(&dock_notifier_list,
726                                                    event, NULL);
727                         hotplug_dock_devices(ds, event);
728                         complete_dock(ds);
729                         dock_event(ds, event, DOCK_EVENT);
730                         dock_lock(ds, 1);
731                         break;
732                 }
733                 if (dock_present(ds) || dock_in_progress(ds))
734                         break;
735                 /* This is a surprise removal */
736                 surprise_removal = 1;
737                 event = ACPI_NOTIFY_EJECT_REQUEST;
738                 /* Fall back */
739         case ACPI_NOTIFY_EJECT_REQUEST:
740                 begin_undock(ds);
741                 if (immediate_undock || surprise_removal)
742                         handle_eject_request(ds, event);
743                 else
744                         dock_event(ds, event, UNDOCK_EVENT);
745                 break;
746         default:
747                 printk(KERN_ERR PREFIX "Unknown dock event %d\n", event);
748         }
749 }
750
751 struct dock_data {
752         acpi_handle handle;
753         unsigned long event;
754         struct dock_station *ds;
755 };
756
757 static void acpi_dock_deferred_cb(void *context)
758 {
759         struct dock_data *data = (struct dock_data *)context;
760
761         dock_notify(data->handle, data->event, data->ds);
762         kfree(data);
763 }
764
765 static int acpi_dock_notifier_call(struct notifier_block *this,
766         unsigned long event, void *data)
767 {
768         struct dock_station *dock_station;
769         acpi_handle handle = (acpi_handle)data;
770
771         if (event != ACPI_NOTIFY_BUS_CHECK && event != ACPI_NOTIFY_DEVICE_CHECK
772            && event != ACPI_NOTIFY_EJECT_REQUEST)
773                 return 0;
774         list_for_each_entry(dock_station, &dock_stations, sibiling) {
775                 if (dock_station->handle == handle) {
776                         struct dock_data *dock_data;
777
778                         dock_data = kmalloc(sizeof(*dock_data), GFP_KERNEL);
779                         if (!dock_data)
780                                 return 0;
781                         dock_data->handle = handle;
782                         dock_data->event = event;
783                         dock_data->ds = dock_station;
784                         acpi_os_hotplug_execute(acpi_dock_deferred_cb,
785                                 dock_data);
786                         return 0 ;
787                 }
788         }
789         return 0;
790 }
791
792 static struct notifier_block dock_acpi_notifier = {
793         .notifier_call = acpi_dock_notifier_call,
794 };
795
796 /**
797  * find_dock_devices - find devices on the dock station
798  * @handle: the handle of the device we are examining
799  * @lvl: unused
800  * @context: the dock station private data
801  * @rv: unused
802  *
803  * This function is called by acpi_walk_namespace.  It will
804  * check to see if an object has an _EJD method.  If it does, then it
805  * will see if it is dependent on the dock station.
806  */
807 static acpi_status
808 find_dock_devices(acpi_handle handle, u32 lvl, void *context, void **rv)
809 {
810         acpi_status status;
811         acpi_handle tmp, parent;
812         struct dock_station *ds = context;
813         struct dock_dependent_device *dd;
814
815         status = acpi_bus_get_ejd(handle, &tmp);
816         if (ACPI_FAILURE(status)) {
817                 /* try the parent device as well */
818                 status = acpi_get_parent(handle, &parent);
819                 if (ACPI_FAILURE(status))
820                         goto fdd_out;
821                 /* see if parent is dependent on dock */
822                 status = acpi_bus_get_ejd(parent, &tmp);
823                 if (ACPI_FAILURE(status))
824                         goto fdd_out;
825         }
826
827         if (tmp == ds->handle) {
828                 dd = alloc_dock_dependent_device(handle);
829                 if (dd)
830                         add_dock_dependent_device(ds, dd);
831         }
832 fdd_out:
833         return AE_OK;
834 }
835
836 /*
837  * show_docked - read method for "docked" file in sysfs
838  */
839 static ssize_t show_docked(struct device *dev,
840                            struct device_attribute *attr, char *buf)
841 {
842         struct dock_station *dock_station = *((struct dock_station **)
843                 dev->platform_data);
844         return snprintf(buf, PAGE_SIZE, "%d\n", dock_present(dock_station));
845
846 }
847 static DEVICE_ATTR(docked, S_IRUGO, show_docked, NULL);
848
849 /*
850  * show_flags - read method for flags file in sysfs
851  */
852 static ssize_t show_flags(struct device *dev,
853                           struct device_attribute *attr, char *buf)
854 {
855         struct dock_station *dock_station = *((struct dock_station **)
856                 dev->platform_data);
857         return snprintf(buf, PAGE_SIZE, "%d\n", dock_station->flags);
858
859 }
860 static DEVICE_ATTR(flags, S_IRUGO, show_flags, NULL);
861
862 /*
863  * write_undock - write method for "undock" file in sysfs
864  */
865 static ssize_t write_undock(struct device *dev, struct device_attribute *attr,
866                            const char *buf, size_t count)
867 {
868         int ret;
869         struct dock_station *dock_station = *((struct dock_station **)
870                 dev->platform_data);
871
872         if (!count)
873                 return -EINVAL;
874
875         begin_undock(dock_station);
876         ret = handle_eject_request(dock_station, ACPI_NOTIFY_EJECT_REQUEST);
877         return ret ? ret: count;
878 }
879 static DEVICE_ATTR(undock, S_IWUSR, NULL, write_undock);
880
881 /*
882  * show_dock_uid - read method for "uid" file in sysfs
883  */
884 static ssize_t show_dock_uid(struct device *dev,
885                              struct device_attribute *attr, char *buf)
886 {
887         unsigned long lbuf;
888         struct dock_station *dock_station = *((struct dock_station **)
889                 dev->platform_data);
890         acpi_status status = acpi_evaluate_integer(dock_station->handle,
891                                         "_UID", NULL, &lbuf);
892         if (ACPI_FAILURE(status))
893             return 0;
894
895         return snprintf(buf, PAGE_SIZE, "%lx\n", lbuf);
896 }
897 static DEVICE_ATTR(uid, S_IRUGO, show_dock_uid, NULL);
898
899 /**
900  * dock_add - add a new dock station
901  * @handle: the dock station handle
902  *
903  * allocated and initialize a new dock station device.  Find all devices
904  * that are on the dock station, and register for dock event notifications.
905  */
906 static int dock_add(acpi_handle handle)
907 {
908         int ret;
909         struct dock_dependent_device *dd;
910         struct dock_station *dock_station;
911         struct platform_device *dock_device;
912
913         /* allocate & initialize the dock_station private data */
914         dock_station = kzalloc(sizeof(*dock_station), GFP_KERNEL);
915         if (!dock_station)
916                 return -ENOMEM;
917         dock_station->handle = handle;
918         dock_station->last_dock_time = jiffies - HZ;
919         INIT_LIST_HEAD(&dock_station->dependent_devices);
920         INIT_LIST_HEAD(&dock_station->hotplug_devices);
921         INIT_LIST_HEAD(&dock_station->sibiling);
922         spin_lock_init(&dock_station->dd_lock);
923         mutex_init(&dock_station->hp_lock);
924         ATOMIC_INIT_NOTIFIER_HEAD(&dock_notifier_list);
925
926         /* initialize platform device stuff */
927         dock_station->dock_device =
928                 platform_device_register_simple(dock_device_name,
929                         dock_station_count, NULL, 0);
930         dock_device = dock_station->dock_device;
931         if (IS_ERR(dock_device)) {
932                 kfree(dock_station);
933                 dock_station = NULL;
934                 return PTR_ERR(dock_device);
935         }
936         platform_device_add_data(dock_device, &dock_station,
937                 sizeof(struct dock_station *));
938
939         /* we want the dock device to send uevents */
940         dock_device->dev.uevent_suppress = 0;
941
942         if (is_dock(handle))
943                 dock_station->flags |= DOCK_IS_DOCK;
944         if (is_ata(handle))
945                 dock_station->flags |= DOCK_IS_ATA;
946         if (is_battery(handle))
947                 dock_station->flags |= DOCK_IS_BAT;
948
949         ret = device_create_file(&dock_device->dev, &dev_attr_docked);
950         if (ret) {
951                 printk("Error %d adding sysfs file\n", ret);
952                 platform_device_unregister(dock_device);
953                 kfree(dock_station);
954                 dock_station = NULL;
955                 return ret;
956         }
957         ret = device_create_file(&dock_device->dev, &dev_attr_undock);
958         if (ret) {
959                 printk("Error %d adding sysfs file\n", ret);
960                 device_remove_file(&dock_device->dev, &dev_attr_docked);
961                 platform_device_unregister(dock_device);
962                 kfree(dock_station);
963                 dock_station = NULL;
964                 return ret;
965         }
966         ret = device_create_file(&dock_device->dev, &dev_attr_uid);
967         if (ret) {
968                 printk("Error %d adding sysfs file\n", ret);
969                 device_remove_file(&dock_device->dev, &dev_attr_docked);
970                 device_remove_file(&dock_device->dev, &dev_attr_undock);
971                 platform_device_unregister(dock_device);
972                 kfree(dock_station);
973                 dock_station = NULL;
974                 return ret;
975         }
976         ret = device_create_file(&dock_device->dev, &dev_attr_flags);
977         if (ret) {
978                 printk("Error %d adding sysfs file\n", ret);
979                 device_remove_file(&dock_device->dev, &dev_attr_docked);
980                 device_remove_file(&dock_device->dev, &dev_attr_undock);
981                 device_remove_file(&dock_device->dev, &dev_attr_uid);
982                 platform_device_unregister(dock_device);
983                 kfree(dock_station);
984                 dock_station = NULL;
985                 return ret;
986         }
987
988         /* Find dependent devices */
989         acpi_walk_namespace(ACPI_TYPE_DEVICE, ACPI_ROOT_OBJECT,
990                             ACPI_UINT32_MAX, find_dock_devices, dock_station,
991                             NULL);
992
993         /* add the dock station as a device dependent on itself */
994         dd = alloc_dock_dependent_device(handle);
995         if (!dd) {
996                 kfree(dock_station);
997                 dock_station = NULL;
998                 ret = -ENOMEM;
999                 goto dock_add_err_unregister;
1000         }
1001         add_dock_dependent_device(dock_station, dd);
1002
1003         dock_station_count++;
1004         list_add(&dock_station->sibiling, &dock_stations);
1005         return 0;
1006
1007 dock_add_err_unregister:
1008         device_remove_file(&dock_device->dev, &dev_attr_docked);
1009         device_remove_file(&dock_device->dev, &dev_attr_undock);
1010         device_remove_file(&dock_device->dev, &dev_attr_uid);
1011         device_remove_file(&dock_device->dev, &dev_attr_flags);
1012         platform_device_unregister(dock_device);
1013         kfree(dock_station);
1014         dock_station = NULL;
1015         return ret;
1016 }
1017
1018 /**
1019  * dock_remove - free up resources related to the dock station
1020  */
1021 static int dock_remove(struct dock_station *dock_station)
1022 {
1023         struct dock_dependent_device *dd, *tmp;
1024         struct platform_device *dock_device = dock_station->dock_device;
1025
1026         if (!dock_station_count)
1027                 return 0;
1028
1029         /* remove dependent devices */
1030         list_for_each_entry_safe(dd, tmp, &dock_station->dependent_devices,
1031                                  list)
1032             kfree(dd);
1033
1034         /* cleanup sysfs */
1035         device_remove_file(&dock_device->dev, &dev_attr_docked);
1036         device_remove_file(&dock_device->dev, &dev_attr_undock);
1037         device_remove_file(&dock_device->dev, &dev_attr_uid);
1038         device_remove_file(&dock_device->dev, &dev_attr_flags);
1039         platform_device_unregister(dock_device);
1040
1041         /* free dock station memory */
1042         kfree(dock_station);
1043         dock_station = NULL;
1044         return 0;
1045 }
1046
1047 /**
1048  * find_dock - look for a dock station
1049  * @handle: acpi handle of a device
1050  * @lvl: unused
1051  * @context: counter of dock stations found
1052  * @rv: unused
1053  *
1054  * This is called by acpi_walk_namespace to look for dock stations.
1055  */
1056 static acpi_status
1057 find_dock(acpi_handle handle, u32 lvl, void *context, void **rv)
1058 {
1059         acpi_status status = AE_OK;
1060
1061         if (is_dock(handle)) {
1062                 if (dock_add(handle) >= 0) {
1063                         status = AE_CTRL_TERMINATE;
1064                 }
1065         }
1066         return status;
1067 }
1068
1069 static acpi_status
1070 find_bay(acpi_handle handle, u32 lvl, void *context, void **rv)
1071 {
1072         /* If bay is in a dock, it's already handled */
1073         if (is_ejectable_bay(handle) && !is_dock_device(handle))
1074                 dock_add(handle);
1075         return AE_OK;
1076 }
1077
1078 static int __init dock_init(void)
1079 {
1080         if (acpi_disabled)
1081                 return 0;
1082
1083         /* look for a dock station */
1084         acpi_walk_namespace(ACPI_TYPE_DEVICE, ACPI_ROOT_OBJECT,
1085                             ACPI_UINT32_MAX, find_dock, NULL, NULL);
1086
1087         /* look for bay */
1088         acpi_walk_namespace(ACPI_TYPE_DEVICE, ACPI_ROOT_OBJECT,
1089                         ACPI_UINT32_MAX, find_bay, NULL, NULL);
1090         if (!dock_station_count) {
1091                 printk(KERN_INFO PREFIX "No dock devices found.\n");
1092                 return 0;
1093         }
1094
1095         register_acpi_bus_notifier(&dock_acpi_notifier);
1096         printk(KERN_INFO PREFIX "%s: %d docks/bays found\n",
1097                 ACPI_DOCK_DRIVER_DESCRIPTION, dock_station_count);
1098         return 0;
1099 }
1100
1101 static void __exit dock_exit(void)
1102 {
1103         struct dock_station *dock_station;
1104
1105         unregister_acpi_bus_notifier(&dock_acpi_notifier);
1106         list_for_each_entry(dock_station, &dock_stations, sibiling)
1107                 dock_remove(dock_station);
1108 }
1109
1110 /*
1111  * Must be called before drivers of devices in dock, otherwise we can't know
1112  * which devices are in a dock
1113  */
1114 subsys_initcall(dock_init);
1115 module_exit(dock_exit);