1
2
3
4
5
6
7
8
9
10
11
12#include <linux/types.h>
13#include <linux/errno.h>
14#include <linux/sched.h>
15#include <linux/kernel.h>
16#include <linux/poll.h>
17#include <linux/proc_fs.h>
18#include <linux/init.h>
19#include <linux/vmalloc.h>
20#include <linux/spinlock.h>
21#include <linux/cpu.h>
22
23#include <asm/uaccess.h>
24#include <asm/io.h>
25#include <asm/rtas.h>
26#include <asm/prom.h>
27#include <asm/nvram.h>
28#include <asm/atomic.h>
29
30#if 0
31#define DEBUG(A...) printk(KERN_ERR A)
32#else
33#define DEBUG(A...)
34#endif
35
36static spinlock_t rtasd_log_lock = SPIN_LOCK_UNLOCKED;
37
38DECLARE_WAIT_QUEUE_HEAD(rtas_log_wait);
39
40static char *rtas_log_buf;
41static unsigned long rtas_log_start;
42static unsigned long rtas_log_size;
43
44static int surveillance_timeout = -1;
45static unsigned int rtas_event_scan_rate;
46static unsigned int rtas_error_log_max;
47static unsigned int rtas_error_log_buffer_max;
48
49extern volatile int no_more_logging;
50
51volatile int error_log_cnt = 0;
52
53
54
55
56
57
58static unsigned char logdata[RTAS_ERROR_LOG_MAX];
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73static void printk_log_rtas(char *buf, int len)
74{
75
76 int i,j,n;
77 int perline = 16;
78 char buffer[64];
79 char * str = "RTAS event";
80
81 printk(RTAS_DEBUG "%d -------- %s begin --------\n", error_log_cnt, str);
82
83
84
85
86
87
88
89 for (i=0; i < len; i++) {
90 j = i % perline;
91 if (j == 0) {
92 memset(buffer, 0, sizeof(buffer));
93 n = sprintf(buffer, "RTAS %d:", i/perline);
94 }
95
96 if ((i % 4) == 0)
97 n += sprintf(buffer+n, " ");
98
99 n += sprintf(buffer+n, "%02x", (unsigned char)buf[i]);
100
101 if (j == (perline-1))
102 printk(KERN_DEBUG "%s\n", buffer);
103 }
104 if ((i % perline) != 0)
105 printk(KERN_DEBUG "%s\n", buffer);
106
107 printk(RTAS_DEBUG "%d -------- %s end ----------\n", error_log_cnt, str);
108}
109
110static int log_rtas_len(char * buf)
111{
112 int len;
113 struct rtas_error_log *err;
114
115
116 len = 8;
117 err = (struct rtas_error_log *)buf;
118 if (err->extended_log_length) {
119
120
121 len += err->extended_log_length;
122 }
123
124 if (len > rtas_error_log_max)
125 len = rtas_error_log_max;
126
127 return len;
128}
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144void pSeries_log_error(char *buf, unsigned int err_type, int fatal)
145{
146 unsigned long offset;
147 unsigned long s;
148 int len = 0;
149
150 DEBUG("logging event\n");
151
152 if (buf == NULL)
153 return;
154
155 spin_lock_irqsave(&rtasd_log_lock, s);
156
157
158 switch (err_type & ERR_TYPE_MASK) {
159 case ERR_TYPE_RTAS_LOG:
160 len = log_rtas_len(buf);
161 if (!(err_type & ERR_FLAG_BOOT))
162 error_log_cnt++;
163 break;
164 case ERR_TYPE_KERNEL_PANIC:
165 default:
166 spin_unlock_irqrestore(&rtasd_log_lock, s);
167 return;
168 }
169
170
171 if (!no_more_logging && !(err_type & ERR_FLAG_BOOT))
172 nvram_write_error_log(buf, len, err_type);
173
174
175 if (fatal || no_more_logging) {
176 no_more_logging = 1;
177 spin_unlock_irqrestore(&rtasd_log_lock, s);
178 return;
179 }
180
181
182 switch (err_type & ERR_TYPE_MASK) {
183 case ERR_TYPE_RTAS_LOG:
184
185 printk_log_rtas(buf, len);
186
187 offset = rtas_error_log_buffer_max *
188 ((rtas_log_start+rtas_log_size) & LOG_NUMBER_MASK);
189
190
191 memcpy(&rtas_log_buf[offset], (void *) &error_log_cnt, sizeof(int));
192
193
194 offset += sizeof(int);
195 memcpy(&rtas_log_buf[offset], buf, len);
196
197 if (rtas_log_size < LOG_NUMBER)
198 rtas_log_size += 1;
199 else
200 rtas_log_start += 1;
201
202 spin_unlock_irqrestore(&rtasd_log_lock, s);
203 wake_up_interruptible(&rtas_log_wait);
204 break;
205 case ERR_TYPE_KERNEL_PANIC:
206 default:
207 spin_unlock_irqrestore(&rtasd_log_lock, s);
208 return;
209 }
210
211}
212
213
214static int rtas_log_open(struct inode * inode, struct file * file)
215{
216 return 0;
217}
218
219static int rtas_log_release(struct inode * inode, struct file * file)
220{
221 return 0;
222}
223
224
225
226
227
228static ssize_t rtas_log_read(struct file * file, char * buf,
229 size_t count, loff_t *ppos)
230{
231 int error;
232 char *tmp;
233 unsigned long s;
234 unsigned long offset;
235
236 if (!buf || count < rtas_error_log_buffer_max)
237 return -EINVAL;
238
239 count = rtas_error_log_buffer_max;
240
241 error = verify_area(VERIFY_WRITE, buf, count);
242 if (error)
243 return -EFAULT;
244
245 tmp = kmalloc(count, GFP_KERNEL);
246 if (!tmp)
247 return -ENOMEM;
248
249
250 spin_lock_irqsave(&rtasd_log_lock, s);
251
252 if (rtas_log_size == 0 && !no_more_logging)
253 nvram_clear_error_log();
254 spin_unlock_irqrestore(&rtasd_log_lock, s);
255
256
257 error = wait_event_interruptible(rtas_log_wait, rtas_log_size);
258 if (error)
259 goto out;
260
261 spin_lock_irqsave(&rtasd_log_lock, s);
262 offset = rtas_error_log_buffer_max * (rtas_log_start & LOG_NUMBER_MASK);
263 memcpy(tmp, &rtas_log_buf[offset], count);
264
265 rtas_log_start += 1;
266 rtas_log_size -= 1;
267 spin_unlock_irqrestore(&rtasd_log_lock, s);
268
269 error = copy_to_user(buf, tmp, count) ? -EFAULT : count;
270out:
271 kfree(tmp);
272 return error;
273}
274
275static unsigned int rtas_log_poll(struct file *file, poll_table * wait)
276{
277 poll_wait(file, &rtas_log_wait, wait);
278 if (rtas_log_size)
279 return POLLIN | POLLRDNORM;
280 return 0;
281}
282
283struct file_operations proc_rtas_log_operations = {
284 .read = rtas_log_read,
285 .poll = rtas_log_poll,
286 .open = rtas_log_open,
287 .release = rtas_log_release,
288};
289
290static int enable_surveillance(int timeout)
291{
292 int error;
293
294 error = rtas_call(rtas_token("set-indicator"), 3, 1, NULL,
295 SURVEILLANCE_TOKEN, 0, timeout);
296
297 if (error) {
298 printk(KERN_ERR "rtasd: could not enable surveillance\n");
299 return -1;
300 }
301
302 return 0;
303}
304
305static int get_eventscan_parms(void)
306{
307 struct device_node *node;
308 int *ip;
309
310 node = of_find_node_by_path("/rtas");
311
312 ip = (int *)get_property(node, "rtas-event-scan-rate", NULL);
313 if (ip == NULL) {
314 printk(KERN_ERR "rtasd: no rtas-event-scan-rate\n");
315 of_node_put(node);
316 return -1;
317 }
318 rtas_event_scan_rate = *ip;
319 DEBUG("rtas-event-scan-rate %d\n", rtas_event_scan_rate);
320
321 ip = (int *)get_property(node, "rtas-error-log-max", NULL);
322 if (ip == NULL) {
323 printk(KERN_ERR "rtasd: no rtas-error-log-max\n");
324 of_node_put(node);
325 return -1;
326 }
327 rtas_error_log_max = *ip;
328 DEBUG("rtas-error-log-max %d\n", rtas_error_log_max);
329
330 if (rtas_error_log_max > RTAS_ERROR_LOG_MAX) {
331 printk(KERN_ERR "rtasd: truncated error log from %d to %d bytes\n", rtas_error_log_max, RTAS_ERROR_LOG_MAX);
332 rtas_error_log_max = RTAS_ERROR_LOG_MAX;
333 }
334
335
336 rtas_error_log_buffer_max = rtas_error_log_max + sizeof(int);
337
338 of_node_put(node);
339
340 return 0;
341}
342
343static void do_event_scan(int event_scan)
344{
345 int error;
346 do {
347 memset(logdata, 0, rtas_error_log_max);
348 error = rtas_call(event_scan, 4, 1, NULL,
349 RTAS_EVENT_SCAN_ALL_EVENTS, 0,
350 __pa(logdata), rtas_error_log_max);
351 if (error == -1) {
352 printk(KERN_ERR "event-scan failed\n");
353 break;
354 }
355
356 if (error == 0)
357 pSeries_log_error(logdata, ERR_TYPE_RTAS_LOG, 0);
358
359 } while(error == 0);
360}
361
362static int rtasd(void *unused)
363{
364 unsigned int err_type;
365 int cpu = 0;
366 int event_scan = rtas_token("event-scan");
367 int rc;
368
369 daemonize("rtasd");
370
371 if (event_scan == RTAS_UNKNOWN_SERVICE || get_eventscan_parms() == -1)
372 goto error;
373
374 rtas_log_buf = vmalloc(rtas_error_log_buffer_max*LOG_NUMBER);
375 if (!rtas_log_buf) {
376 printk(KERN_ERR "rtasd: no memory\n");
377 goto error;
378 }
379
380
381 no_more_logging = 0;
382
383 printk(KERN_ERR "RTAS daemon started\n");
384
385 DEBUG("will sleep for %d jiffies\n", (HZ*60/rtas_event_scan_rate) / 2);
386
387
388 memset(logdata, 0, rtas_error_log_max);
389
390 rc = nvram_read_error_log(logdata, rtas_error_log_max, &err_type);
391 if (!rc) {
392 if (err_type != ERR_FLAG_ALREADY_LOGGED) {
393 pSeries_log_error(logdata, err_type | ERR_FLAG_BOOT, 0);
394 }
395 }
396
397
398 lock_cpu_hotplug();
399 for_each_online_cpu(cpu) {
400 DEBUG("scheduling on %d\n", cpu);
401 set_cpus_allowed(current, cpumask_of_cpu(cpu));
402 DEBUG("watchdog scheduled on cpu %d\n", smp_processor_id());
403
404 do_event_scan(event_scan);
405 set_current_state(TASK_INTERRUPTIBLE);
406 schedule_timeout(HZ);
407 }
408 unlock_cpu_hotplug();
409
410 if (surveillance_timeout != -1) {
411 DEBUG("enabling surveillance\n");
412 enable_surveillance(surveillance_timeout);
413 DEBUG("surveillance enabled\n");
414 }
415
416 lock_cpu_hotplug();
417 cpu = first_cpu(cpu_online_map);
418 for (;;) {
419 set_cpus_allowed(current, cpumask_of_cpu(cpu));
420 do_event_scan(event_scan);
421 set_cpus_allowed(current, CPU_MASK_ALL);
422
423
424
425
426 unlock_cpu_hotplug();
427 set_current_state(TASK_INTERRUPTIBLE);
428 schedule_timeout((HZ*60/rtas_event_scan_rate) / 2);
429 lock_cpu_hotplug();
430
431 cpu = next_cpu(cpu, cpu_online_map);
432 if (cpu == NR_CPUS)
433 cpu = first_cpu(cpu_online_map);
434 }
435
436error:
437
438 return -EINVAL;
439}
440
441static int __init rtas_init(void)
442{
443 struct proc_dir_entry *entry;
444
445
446 if (rtas_token("event-scan") == RTAS_UNKNOWN_SERVICE) {
447 if (systemcfg->platform & PLATFORM_PSERIES);
448 printk(KERN_ERR "rtasd: no RTAS on system\n");
449 return 1;
450 }
451
452 entry = create_proc_entry("ppc64/rtas/error_log", S_IRUSR, NULL);
453 if (entry)
454 entry->proc_fops = &proc_rtas_log_operations;
455 else
456 printk(KERN_ERR "Failed to create error_log proc entry\n");
457
458 if (kernel_thread(rtasd, NULL, CLONE_FS) < 0)
459 printk(KERN_ERR "Failed to start RTAS daemon\n");
460
461 return 0;
462}
463
464static int __init surveillance_setup(char *str)
465{
466 int i;
467
468 if (get_option(&str,&i)) {
469 if (i >= 0 && i <= 255)
470 surveillance_timeout = i;
471 }
472
473 return 1;
474}
475
476__initcall(rtas_init);
477__setup("surveillance=", surveillance_setup);
478