Blame view

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

70c3967d4   Johannes Berg   [POWERPC] Convert...
113
114
115
116
  	return led_classdev_register(NULL, &pmu_led);
  }
  
  late_initcall(via_pmu_led_init);