Merge branch 'for-linus' of git://git.kernel.org/pub/scm/linux/kernel/git/geert/linux...
[linux-2.6] / drivers / macintosh / via-pmu-led.c
1 /*
2  * via-pmu LED class device
3  *
4  * Copyright 2006 Johannes Berg <johannes@sipsolutions.net>
5  *
6  * This program is free software; you can redistribute it and/or modify
7  * it under the terms of the GNU General Public License as published by
8  * the Free Software Foundation; either version 2 of the License, or
9  * (at your option) any later version.
10  *
11  * This program is distributed in the hope that it will be useful, but
12  * WITHOUT ANY WARRANTY; without even the implied warranty of
13  * MERCHANTABILITY OR FITNESS FOR A PARTICULAR PURPOSE, GOOD TITLE or
14  * NON INFRINGEMENT.  See the GNU General Public License for more
15  * details.
16  *
17  * You should have received a copy of the GNU General Public License
18  * along with this program; if not, write to the Free Software
19  * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA  02110-1301 USA
20  *
21  */
22 #include <linux/types.h>
23 #include <linux/kernel.h>
24 #include <linux/device.h>
25 #include <linux/leds.h>
26 #include <linux/adb.h>
27 #include <linux/pmu.h>
28 #include <asm/prom.h>
29
30 static spinlock_t pmu_blink_lock;
31 static struct adb_request pmu_blink_req;
32 /* -1: no change, 0: request off, 1: request on */
33 static int requested_change;
34
35 static void pmu_req_done(struct adb_request * req)
36 {
37         unsigned long flags;
38
39         spin_lock_irqsave(&pmu_blink_lock, flags);
40         /* if someone requested a change in the meantime
41          * (we only see the last one which is fine)
42          * then apply it now */
43         if (requested_change != -1 && !pmu_sys_suspended)
44                 pmu_request(&pmu_blink_req, NULL, 4, 0xee, 4, 0, requested_change);
45         /* reset requested change */
46         requested_change = -1;
47         spin_unlock_irqrestore(&pmu_blink_lock, flags);
48 }
49
50 static void pmu_led_set(struct led_classdev *led_cdev,
51                         enum led_brightness brightness)
52 {
53         unsigned long flags;
54
55         spin_lock_irqsave(&pmu_blink_lock, flags);
56         switch (brightness) {
57         case LED_OFF:
58                 requested_change = 0;
59                 break;
60         case LED_FULL:
61                 requested_change = 1;
62                 break;
63         default:
64                 goto out;
65                 break;
66         }
67         /* if request isn't done, then don't do anything */
68         if (pmu_blink_req.complete && !pmu_sys_suspended)
69                 pmu_request(&pmu_blink_req, NULL, 4, 0xee, 4, 0, requested_change);
70  out:
71         spin_unlock_irqrestore(&pmu_blink_lock, flags);
72 }
73
74 static struct led_classdev pmu_led = {
75         .name = "pmu-front-led",
76 #ifdef CONFIG_ADB_PMU_LED_IDE
77         .default_trigger = "ide-disk",
78 #endif
79         .brightness_set = pmu_led_set,
80 };
81
82 static int __init via_pmu_led_init(void)
83 {
84         struct device_node *dt;
85         const char *model;
86
87         /* only do this on keylargo based models */
88         if (pmu_get_model() != PMU_KEYLARGO_BASED)
89                 return -ENODEV;
90
91         dt = of_find_node_by_path("/");
92         if (dt == NULL)
93                 return -ENODEV;
94         model = of_get_property(dt, "model", NULL);
95         if (model == NULL)
96                 return -ENODEV;
97         if (strncmp(model, "PowerBook", strlen("PowerBook")) != 0 &&
98             strncmp(model, "iBook", strlen("iBook")) != 0 &&
99             strcmp(model, "PowerMac7,2") != 0 &&
100             strcmp(model, "PowerMac7,3") != 0) {
101                 of_node_put(dt);
102                 /* ignore */
103                 return -ENODEV;
104         }
105         of_node_put(dt);
106
107         spin_lock_init(&pmu_blink_lock);
108         /* no outstanding req */
109         pmu_blink_req.complete = 1;
110         pmu_blink_req.done = pmu_req_done;
111
112         return led_classdev_register(NULL, &pmu_led);
113 }
114
115 late_initcall(via_pmu_led_init);