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
34
35
36
37#include <linux/module.h>
38#include <linux/init.h>
39#include <linux/kernel.h>
40#include <linux/notifier.h>
41#include <linux/reboot.h>
42#include <linux/sched.h>
43#include <linux/kthread.h>
44#include <linux/pm.h>
45
46#include <asm/pdc.h>
47#include <asm/io.h>
48#include <asm/led.h>
49
50#define DRIVER_NAME "powersw"
51#define KTHREAD_NAME "kpowerswd"
52
53
54#define POWERSWITCH_POLL_PER_SEC 2
55
56
57#define POWERSWITCH_DOWN_SEC 2
58
59
60
61#define DIAG_CODE(code) (0x14000000 + ((code)<<5))
62
63#define MFCPU_X(rDiagReg, t_ch, t_th, code) \
64 (DIAG_CODE(code) + ((rDiagReg)<<21) + ((t_ch)<<16) + ((t_th)<<0) )
65
66#define MTCPU(dr, gr) MFCPU_X(dr, gr, 0, 0x12)
67#define MFCPU_C(dr, gr) MFCPU_X(dr, gr, 0, 0x30)
68#define MFCPU_T(dr, gr) MFCPU_X(dr, 0, gr, 0xa0)
69
70#define __getDIAG(dr) ( { \
71 register unsigned long __res asm("r28");\
72 __asm__ __volatile__ ( \
73 ".word %1" : "=&r" (__res) : "i" (MFCPU_T(dr,28) ) \
74 ); \
75 __res; \
76} )
77
78
79static int shutdown_timer __read_mostly;
80
81
82static void process_shutdown(void)
83{
84 if (shutdown_timer == 0)
85 printk(KERN_ALERT KTHREAD_NAME ": Shutdown requested...\n");
86
87 shutdown_timer++;
88
89
90 if (shutdown_timer == (POWERSWITCH_DOWN_SEC*POWERSWITCH_POLL_PER_SEC)) {
91 static const char msg[] = "Shutting down...";
92 printk(KERN_INFO KTHREAD_NAME ": %s\n", msg);
93 lcd_print(msg);
94
95
96 if (kill_cad_pid(SIGINT, 1)) {
97
98 if (pm_power_off)
99 pm_power_off();
100 }
101 }
102}
103
104
105
106static struct task_struct *power_task;
107
108
109#define SYSCTL_FILENAME "sys/kernel/power"
110
111
112int pwrsw_enabled __read_mostly = 1;
113
114
115static int kpowerswd(void *param)
116{
117 __set_current_state(TASK_RUNNING);
118
119 do {
120 int button_not_pressed;
121 unsigned long soft_power_reg = (unsigned long) param;
122
123 schedule_timeout_interruptible(pwrsw_enabled ? HZ : HZ/POWERSWITCH_POLL_PER_SEC);
124
125 if (unlikely(!pwrsw_enabled))
126 continue;
127
128 if (soft_power_reg) {
129
130
131
132
133
134
135
136 button_not_pressed = (gsc_readl(soft_power_reg) & 0x1);
137 } else {
138
139
140
141
142
143
144
145 button_not_pressed = (__getDIAG(25) & 0x80000000);
146 }
147
148 if (likely(button_not_pressed)) {
149 if (unlikely(shutdown_timer &&
150 shutdown_timer < (POWERSWITCH_DOWN_SEC*POWERSWITCH_POLL_PER_SEC))) {
151 shutdown_timer = 0;
152 printk(KERN_INFO KTHREAD_NAME ": Shutdown request aborted.\n");
153 }
154 } else
155 process_shutdown();
156
157
158 } while (!kthread_should_stop());
159
160 return 0;
161}
162
163
164
165
166
167#if 0
168static void powerfail_interrupt(int code, void *x)
169{
170 printk(KERN_CRIT "POWERFAIL INTERRUPTION !\n");
171 poweroff();
172}
173#endif
174
175
176
177
178
179
180
181
182
183static int parisc_panic_event(struct notifier_block *this,
184 unsigned long event, void *ptr)
185{
186
187 pdc_soft_power_button(0);
188 return NOTIFY_DONE;
189}
190
191static struct notifier_block parisc_panic_block = {
192 .notifier_call = parisc_panic_event,
193 .priority = INT_MAX,
194};
195
196
197static int __init power_init(void)
198{
199 unsigned long ret;
200 unsigned long soft_power_reg;
201
202#if 0
203 request_irq( IRQ_FROM_REGION(CPU_IRQ_REGION)+2, &powerfail_interrupt,
204 0, "powerfail", NULL);
205#endif
206
207
208 ret = pdc_soft_power_info(&soft_power_reg);
209 if (ret == PDC_OK)
210 ret = pdc_soft_power_button(1);
211 if (ret != PDC_OK)
212 soft_power_reg = -1UL;
213
214 switch (soft_power_reg) {
215 case 0: printk(KERN_INFO DRIVER_NAME ": Gecko-style soft power switch enabled.\n");
216 break;
217
218 case -1UL: printk(KERN_INFO DRIVER_NAME ": Soft power switch support not available.\n");
219 return -ENODEV;
220
221 default: printk(KERN_INFO DRIVER_NAME ": Soft power switch at 0x%08lx enabled.\n",
222 soft_power_reg);
223 }
224
225 power_task = kthread_run(kpowerswd, (void*)soft_power_reg, KTHREAD_NAME);
226 if (IS_ERR(power_task)) {
227 printk(KERN_ERR DRIVER_NAME ": thread creation failed. Driver not loaded.\n");
228 pdc_soft_power_button(0);
229 return -EIO;
230 }
231
232
233 atomic_notifier_chain_register(&panic_notifier_list,
234 &parisc_panic_block);
235
236 return 0;
237}
238
239static void __exit power_exit(void)
240{
241 kthread_stop(power_task);
242
243 atomic_notifier_chain_unregister(&panic_notifier_list,
244 &parisc_panic_block);
245
246 pdc_soft_power_button(0);
247}
248
249arch_initcall(power_init);
250module_exit(power_exit);
251
252
253MODULE_AUTHOR("Helge Deller <deller@gmx.de>");
254MODULE_DESCRIPTION("Soft power switch driver");
255MODULE_LICENSE("Dual BSD/GPL");
256