Merge remote-tracking branch 'remotes/aosp/android-3.0' into develop-3.0
[firefly-linux-kernel-4.4.55.git] / kernel / printk.c
1 /*
2  *  linux/kernel/printk.c
3  *
4  *  Copyright (C) 1991, 1992  Linus Torvalds
5  *
6  * Modified to make sys_syslog() more flexible: added commands to
7  * return the last 4k of kernel messages, regardless of whether
8  * they've been read or not.  Added option to suppress kernel printk's
9  * to the console.  Added hook for sending the console messages
10  * elsewhere, in preparation for a serial line console (someday).
11  * Ted Ts'o, 2/11/93.
12  * Modified for sysctl support, 1/8/97, Chris Horn.
13  * Fixed SMP synchronization, 08/08/99, Manfred Spraul
14  *     manfred@colorfullife.com
15  * Rewrote bits to get rid of console_lock
16  *      01Mar01 Andrew Morton
17  */
18
19 #include <linux/kernel.h>
20 #include <linux/mm.h>
21 #include <linux/tty.h>
22 #include <linux/tty_driver.h>
23 #include <linux/console.h>
24 #include <linux/init.h>
25 #include <linux/jiffies.h>
26 #include <linux/nmi.h>
27 #include <linux/module.h>
28 #include <linux/moduleparam.h>
29 #include <linux/interrupt.h>                    /* For in_interrupt() */
30 #include <linux/delay.h>
31 #include <linux/smp.h>
32 #include <linux/security.h>
33 #include <linux/bootmem.h>
34 #include <linux/memblock.h>
35 #include <linux/syscalls.h>
36 #include <linux/kexec.h>
37 #include <linux/kdb.h>
38 #include <linux/ratelimit.h>
39 #include <linux/kmsg_dump.h>
40 #include <linux/syslog.h>
41 #include <linux/cpu.h>
42 #include <linux/notifier.h>
43 #include <linux/rculist.h>
44
45 #include <asm/uaccess.h>
46
47 /*
48  * Architectures can override it:
49  */
50 void asmlinkage __attribute__((weak)) early_printk(const char *fmt, ...)
51 {
52 }
53
54 #define __LOG_BUF_LEN   (1 << CONFIG_LOG_BUF_SHIFT)
55
56 #ifdef        CONFIG_DEBUG_LL
57 extern void printascii(char *);
58 #endif
59
60 /* printk's without a loglevel use this.. */
61 #define DEFAULT_MESSAGE_LOGLEVEL CONFIG_DEFAULT_MESSAGE_LOGLEVEL
62
63 /* We show everything that is MORE important than this.. */
64 #define MINIMUM_CONSOLE_LOGLEVEL 1 /* Minimum loglevel we let people use */
65 #define DEFAULT_CONSOLE_LOGLEVEL 7 /* anything MORE serious than KERN_DEBUG */
66
67 DECLARE_WAIT_QUEUE_HEAD(log_wait);
68
69 int console_printk[4] = {
70         DEFAULT_CONSOLE_LOGLEVEL,       /* console_loglevel */
71         DEFAULT_MESSAGE_LOGLEVEL,       /* default_message_loglevel */
72         MINIMUM_CONSOLE_LOGLEVEL,       /* minimum_console_loglevel */
73         DEFAULT_CONSOLE_LOGLEVEL,       /* default_console_loglevel */
74 };
75
76 /*
77  * Low level drivers may need that to know if they can schedule in
78  * their unblank() callback or not. So let's export it.
79  */
80 int oops_in_progress;
81 EXPORT_SYMBOL(oops_in_progress);
82
83 /*
84  * console_sem protects the console_drivers list, and also
85  * provides serialisation for access to the entire console
86  * driver system.
87  */
88 static DEFINE_SEMAPHORE(console_sem);
89 struct console *console_drivers;
90 EXPORT_SYMBOL_GPL(console_drivers);
91
92 /*
93  * This is used for debugging the mess that is the VT code by
94  * keeping track if we have the console semaphore held. It's
95  * definitely not the perfect debug tool (we don't know if _WE_
96  * hold it are racing, but it helps tracking those weird code
97  * path in the console code where we end up in places I want
98  * locked without the console sempahore held
99  */
100 static int console_locked, console_suspended;
101
102 /*
103  * logbuf_lock protects log_buf, log_start, log_end, con_start and logged_chars
104  * It is also used in interesting ways to provide interlocking in
105  * console_unlock();.
106  */
107 static DEFINE_SPINLOCK(logbuf_lock);
108
109 #define LOG_BUF_MASK (log_buf_len-1)
110 #define LOG_BUF(idx) (log_buf[(idx) & LOG_BUF_MASK])
111
112 /*
113  * The indices into log_buf are not constrained to log_buf_len - they
114  * must be masked before subscripting
115  */
116 static unsigned log_start;      /* Index into log_buf: next char to be read by syslog() */
117 static unsigned con_start;      /* Index into log_buf: next char to be sent to consoles */
118 static unsigned log_end;        /* Index into log_buf: most-recently-written-char + 1 */
119
120 /*
121  * If exclusive_console is non-NULL then only this console is to be printed to.
122  */
123 static struct console *exclusive_console;
124
125 /*
126  *      Array of consoles built from command line options (console=)
127  */
128 struct console_cmdline
129 {
130         char    name[8];                        /* Name of the driver       */
131         int     index;                          /* Minor dev. to use        */
132         char    *options;                       /* Options for the driver   */
133 #ifdef CONFIG_A11Y_BRAILLE_CONSOLE
134         char    *brl_options;                   /* Options for braille driver */
135 #endif
136 };
137
138 #define MAX_CMDLINECONSOLES 8
139
140 static struct console_cmdline console_cmdline[MAX_CMDLINECONSOLES];
141 static int selected_console = -1;
142 static int preferred_console = -1;
143 int console_set_on_cmdline;
144 EXPORT_SYMBOL(console_set_on_cmdline);
145
146 /* Flag: console code may call schedule() */
147 static int console_may_schedule;
148
149 #ifdef CONFIG_PRINTK
150
151 static char __log_buf[__LOG_BUF_LEN];
152 static char *log_buf = __log_buf;
153 static int log_buf_len = __LOG_BUF_LEN;
154 static unsigned logged_chars; /* Number of chars produced since last read+clear operation */
155 static int saved_console_loglevel = -1;
156
157 #ifdef CONFIG_KEXEC
158 /*
159  * This appends the listed symbols to /proc/vmcoreinfo
160  *
161  * /proc/vmcoreinfo is used by various utiilties, like crash and makedumpfile to
162  * obtain access to symbols that are otherwise very difficult to locate.  These
163  * symbols are specifically used so that utilities can access and extract the
164  * dmesg log from a vmcore file after a crash.
165  */
166 void log_buf_kexec_setup(void)
167 {
168         VMCOREINFO_SYMBOL(log_buf);
169         VMCOREINFO_SYMBOL(log_end);
170         VMCOREINFO_SYMBOL(log_buf_len);
171         VMCOREINFO_SYMBOL(logged_chars);
172 }
173 #endif
174
175 /* requested log_buf_len from kernel cmdline */
176 static unsigned long __initdata new_log_buf_len;
177
178 /* save requested log_buf_len since it's too early to process it */
179 static int __init log_buf_len_setup(char *str)
180 {
181         unsigned size = memparse(str, &str);
182
183         if (size)
184                 size = roundup_pow_of_two(size);
185         if (size > log_buf_len)
186                 new_log_buf_len = size;
187
188         return 0;
189 }
190 early_param("log_buf_len", log_buf_len_setup);
191
192 void __init setup_log_buf(int early)
193 {
194         unsigned long flags;
195         unsigned start, dest_idx, offset;
196         char *new_log_buf;
197         int free;
198
199         if (!new_log_buf_len)
200                 return;
201
202         if (early) {
203                 unsigned long mem;
204
205                 mem = memblock_alloc(new_log_buf_len, PAGE_SIZE);
206                 if (mem == MEMBLOCK_ERROR)
207                         return;
208                 new_log_buf = __va(mem);
209         } else {
210                 new_log_buf = alloc_bootmem_nopanic(new_log_buf_len);
211         }
212
213         if (unlikely(!new_log_buf)) {
214                 pr_err("log_buf_len: %ld bytes not available\n",
215                         new_log_buf_len);
216                 return;
217         }
218
219         spin_lock_irqsave(&logbuf_lock, flags);
220         log_buf_len = new_log_buf_len;
221         log_buf = new_log_buf;
222         new_log_buf_len = 0;
223         free = __LOG_BUF_LEN - log_end;
224
225         offset = start = min(con_start, log_start);
226         dest_idx = 0;
227         while (start != log_end) {
228                 unsigned log_idx_mask = start & (__LOG_BUF_LEN - 1);
229
230                 log_buf[dest_idx] = __log_buf[log_idx_mask];
231                 start++;
232                 dest_idx++;
233         }
234         log_start -= offset;
235         con_start -= offset;
236         log_end -= offset;
237         spin_unlock_irqrestore(&logbuf_lock, flags);
238
239         pr_info("log_buf_len: %d\n", log_buf_len);
240         pr_info("early log buf free: %d(%d%%)\n",
241                 free, (free * 100) / __LOG_BUF_LEN);
242 }
243
244 #ifdef CONFIG_BOOT_PRINTK_DELAY
245
246 static int boot_delay; /* msecs delay after each printk during bootup */
247 static unsigned long long loops_per_msec;       /* based on boot_delay */
248
249 static int __init boot_delay_setup(char *str)
250 {
251         unsigned long lpj;
252
253         lpj = preset_lpj ? preset_lpj : 1000000;        /* some guess */
254         loops_per_msec = (unsigned long long)lpj / 1000 * HZ;
255
256         get_option(&str, &boot_delay);
257         if (boot_delay > 10 * 1000)
258                 boot_delay = 0;
259
260         pr_debug("boot_delay: %u, preset_lpj: %ld, lpj: %lu, "
261                 "HZ: %d, loops_per_msec: %llu\n",
262                 boot_delay, preset_lpj, lpj, HZ, loops_per_msec);
263         return 1;
264 }
265 __setup("boot_delay=", boot_delay_setup);
266
267 static void boot_delay_msec(void)
268 {
269         unsigned long long k;
270         unsigned long timeout;
271
272         if (boot_delay == 0 || system_state != SYSTEM_BOOTING)
273                 return;
274
275         k = (unsigned long long)loops_per_msec * boot_delay;
276
277         timeout = jiffies + msecs_to_jiffies(boot_delay);
278         while (k) {
279                 k--;
280                 cpu_relax();
281                 /*
282                  * use (volatile) jiffies to prevent
283                  * compiler reduction; loop termination via jiffies
284                  * is secondary and may or may not happen.
285                  */
286                 if (time_after(jiffies, timeout))
287                         break;
288                 touch_nmi_watchdog();
289         }
290 }
291 #else
292 static inline void boot_delay_msec(void)
293 {
294 }
295 #endif
296
297 /*
298  * Return the number of unread characters in the log buffer.
299  */
300 static int log_buf_get_len(void)
301 {
302         return logged_chars;
303 }
304
305 /*
306  * Clears the ring-buffer
307  */
308 void log_buf_clear(void)
309 {
310         logged_chars = 0;
311 }
312
313 /*
314  * Copy a range of characters from the log buffer.
315  */
316 int log_buf_copy(char *dest, int idx, int len)
317 {
318         int ret, max;
319         bool took_lock = false;
320
321         if (!oops_in_progress) {
322                 spin_lock_irq(&logbuf_lock);
323                 took_lock = true;
324         }
325
326         max = log_buf_get_len();
327         if (idx < 0 || idx >= max) {
328                 ret = -1;
329         } else {
330                 if (len > max - idx)
331                         len = max - idx;
332                 ret = len;
333                 idx += (log_end - max);
334                 while (len-- > 0)
335                         dest[len] = LOG_BUF(idx + len);
336         }
337
338         if (took_lock)
339                 spin_unlock_irq(&logbuf_lock);
340
341         return ret;
342 }
343
344 #ifdef CONFIG_SECURITY_DMESG_RESTRICT
345 int dmesg_restrict = 1;
346 #else
347 int dmesg_restrict;
348 #endif
349
350 static int syslog_action_restricted(int type)
351 {
352         if (dmesg_restrict)
353                 return 1;
354         /* Unless restricted, we allow "read all" and "get buffer size" for everybody */
355         return type != SYSLOG_ACTION_READ_ALL && type != SYSLOG_ACTION_SIZE_BUFFER;
356 }
357
358 static int check_syslog_permissions(int type, bool from_file)
359 {
360         /*
361          * If this is from /proc/kmsg and we've already opened it, then we've
362          * already done the capabilities checks at open time.
363          */
364         if (from_file && type != SYSLOG_ACTION_OPEN)
365                 return 0;
366
367         if (syslog_action_restricted(type)) {
368                 if (capable(CAP_SYSLOG))
369                         return 0;
370                 /* For historical reasons, accept CAP_SYS_ADMIN too, with a warning */
371                 if (capable(CAP_SYS_ADMIN)) {
372                         WARN_ONCE(1, "Attempt to access syslog with CAP_SYS_ADMIN "
373                                  "but no CAP_SYSLOG (deprecated).\n");
374                         return 0;
375                 }
376                 return -EPERM;
377         }
378         return 0;
379 }
380
381 int do_syslog(int type, char __user *buf, int len, bool from_file)
382 {
383         unsigned i, j, limit, count;
384         int do_clear = 0;
385         char c;
386         int error;
387
388         error = check_syslog_permissions(type, from_file);
389         if (error)
390                 goto out;
391
392         error = security_syslog(type);
393         if (error)
394                 return error;
395
396         switch (type) {
397         case SYSLOG_ACTION_CLOSE:       /* Close log */
398                 break;
399         case SYSLOG_ACTION_OPEN:        /* Open log */
400                 break;
401         case SYSLOG_ACTION_READ:        /* Read from log */
402                 error = -EINVAL;
403                 if (!buf || len < 0)
404                         goto out;
405                 error = 0;
406                 if (!len)
407                         goto out;
408                 if (!access_ok(VERIFY_WRITE, buf, len)) {
409                         error = -EFAULT;
410                         goto out;
411                 }
412                 error = wait_event_interruptible(log_wait,
413                                                         (log_start - log_end));
414                 if (error)
415                         goto out;
416                 i = 0;
417                 spin_lock_irq(&logbuf_lock);
418                 while (!error && (log_start != log_end) && i < len) {
419                         c = LOG_BUF(log_start);
420                         log_start++;
421                         spin_unlock_irq(&logbuf_lock);
422                         error = __put_user(c,buf);
423                         buf++;
424                         i++;
425                         cond_resched();
426                         spin_lock_irq(&logbuf_lock);
427                 }
428                 spin_unlock_irq(&logbuf_lock);
429                 if (!error)
430                         error = i;
431                 break;
432         /* Read/clear last kernel messages */
433         case SYSLOG_ACTION_READ_CLEAR:
434                 do_clear = 1;
435                 /* FALL THRU */
436         /* Read last kernel messages */
437         case SYSLOG_ACTION_READ_ALL:
438                 error = -EINVAL;
439                 if (!buf || len < 0)
440                         goto out;
441                 error = 0;
442                 if (!len)
443                         goto out;
444                 if (!access_ok(VERIFY_WRITE, buf, len)) {
445                         error = -EFAULT;
446                         goto out;
447                 }
448                 count = len;
449                 if (count > log_buf_len)
450                         count = log_buf_len;
451                 spin_lock_irq(&logbuf_lock);
452                 if (count > logged_chars)
453                         count = logged_chars;
454                 if (do_clear)
455                         logged_chars = 0;
456                 limit = log_end;
457                 /*
458                  * __put_user() could sleep, and while we sleep
459                  * printk() could overwrite the messages
460                  * we try to copy to user space. Therefore
461                  * the messages are copied in reverse. <manfreds>
462                  */
463                 for (i = 0; i < count && !error; i++) {
464                         j = limit-1-i;
465                         if (j + log_buf_len < log_end)
466                                 break;
467                         c = LOG_BUF(j);
468                         spin_unlock_irq(&logbuf_lock);
469                         error = __put_user(c,&buf[count-1-i]);
470                         cond_resched();
471                         spin_lock_irq(&logbuf_lock);
472                 }
473                 spin_unlock_irq(&logbuf_lock);
474                 if (error)
475                         break;
476                 error = i;
477                 if (i != count) {
478                         int offset = count-error;
479                         /* buffer overflow during copy, correct user buffer. */
480                         for (i = 0; i < error; i++) {
481                                 if (__get_user(c,&buf[i+offset]) ||
482                                     __put_user(c,&buf[i])) {
483                                         error = -EFAULT;
484                                         break;
485                                 }
486                                 cond_resched();
487                         }
488                 }
489                 break;
490         /* Clear ring buffer */
491         case SYSLOG_ACTION_CLEAR:
492                 logged_chars = 0;
493                 break;
494         /* Disable logging to console */
495         case SYSLOG_ACTION_CONSOLE_OFF:
496                 if (saved_console_loglevel == -1)
497                         saved_console_loglevel = console_loglevel;
498                 console_loglevel = minimum_console_loglevel;
499                 break;
500         /* Enable logging to console */
501         case SYSLOG_ACTION_CONSOLE_ON:
502                 if (saved_console_loglevel != -1) {
503                         console_loglevel = saved_console_loglevel;
504                         saved_console_loglevel = -1;
505                 }
506                 break;
507         /* Set level of messages printed to console */
508         case SYSLOG_ACTION_CONSOLE_LEVEL:
509                 error = -EINVAL;
510                 if (len < 1 || len > 8)
511                         goto out;
512                 if (len < minimum_console_loglevel)
513                         len = minimum_console_loglevel;
514                 console_loglevel = len;
515                 /* Implicitly re-enable logging to console */
516                 saved_console_loglevel = -1;
517                 error = 0;
518                 break;
519         /* Number of chars in the log buffer */
520         case SYSLOG_ACTION_SIZE_UNREAD:
521                 error = log_end - log_start;
522                 break;
523         /* Size of the log buffer */
524         case SYSLOG_ACTION_SIZE_BUFFER:
525                 error = log_buf_len;
526                 break;
527         default:
528                 error = -EINVAL;
529                 break;
530         }
531 out:
532         return error;
533 }
534
535 SYSCALL_DEFINE3(syslog, int, type, char __user *, buf, int, len)
536 {
537         return do_syslog(type, buf, len, SYSLOG_FROM_CALL);
538 }
539
540 #ifdef  CONFIG_KGDB_KDB
541 /* kdb dmesg command needs access to the syslog buffer.  do_syslog()
542  * uses locks so it cannot be used during debugging.  Just tell kdb
543  * where the start and end of the physical and logical logs are.  This
544  * is equivalent to do_syslog(3).
545  */
546 void kdb_syslog_data(char *syslog_data[4])
547 {
548         syslog_data[0] = log_buf;
549         syslog_data[1] = log_buf + log_buf_len;
550         syslog_data[2] = log_buf + log_end -
551                 (logged_chars < log_buf_len ? logged_chars : log_buf_len);
552         syslog_data[3] = log_buf + log_end;
553 }
554 #endif  /* CONFIG_KGDB_KDB */
555
556 /*
557  * Call the console drivers on a range of log_buf
558  */
559 static void __call_console_drivers(unsigned start, unsigned end)
560 {
561         struct console *con;
562
563         for_each_console(con) {
564                 if (exclusive_console && con != exclusive_console)
565                         continue;
566                 if ((con->flags & CON_ENABLED) && con->write &&
567                                 (cpu_online(smp_processor_id()) ||
568                                 (con->flags & CON_ANYTIME)))
569                         con->write(con, &LOG_BUF(start), end - start);
570         }
571 }
572
573 static int __read_mostly ignore_loglevel;
574
575 static int __init ignore_loglevel_setup(char *str)
576 {
577         ignore_loglevel = 1;
578         printk(KERN_INFO "debug: ignoring loglevel setting.\n");
579
580         return 0;
581 }
582
583 early_param("ignore_loglevel", ignore_loglevel_setup);
584
585 /*
586  * Write out chars from start to end - 1 inclusive
587  */
588 static void _call_console_drivers(unsigned start,
589                                 unsigned end, int msg_log_level)
590 {
591         if ((msg_log_level < console_loglevel || ignore_loglevel) &&
592                         console_drivers && start != end) {
593                 if ((start & LOG_BUF_MASK) > (end & LOG_BUF_MASK)) {
594                         /* wrapped write */
595                         __call_console_drivers(start & LOG_BUF_MASK,
596                                                 log_buf_len);
597                         __call_console_drivers(0, end & LOG_BUF_MASK);
598                 } else {
599                         __call_console_drivers(start, end);
600                 }
601         }
602 }
603
604 /*
605  * Parse the syslog header <[0-9]*>. The decimal value represents 32bit, the
606  * lower 3 bit are the log level, the rest are the log facility. In case
607  * userspace passes usual userspace syslog messages to /dev/kmsg or
608  * /dev/ttyprintk, the log prefix might contain the facility. Printk needs
609  * to extract the correct log level for in-kernel processing, and not mangle
610  * the original value.
611  *
612  * If a prefix is found, the length of the prefix is returned. If 'level' is
613  * passed, it will be filled in with the log level without a possible facility
614  * value. If 'special' is passed, the special printk prefix chars are accepted
615  * and returned. If no valid header is found, 0 is returned and the passed
616  * variables are not touched.
617  */
618 static size_t log_prefix(const char *p, unsigned int *level, char *special)
619 {
620         unsigned int lev = 0;
621         char sp = '\0';
622         size_t len;
623
624         if (p[0] != '<' || !p[1])
625                 return 0;
626         if (p[2] == '>') {
627                 /* usual single digit level number or special char */
628                 switch (p[1]) {
629                 case '0' ... '7':
630                         lev = p[1] - '0';
631                         break;
632                 case 'c': /* KERN_CONT */
633                 case 'd': /* KERN_DEFAULT */
634                         sp = p[1];
635                         break;
636                 default:
637                         return 0;
638                 }
639                 len = 3;
640         } else {
641                 /* multi digit including the level and facility number */
642                 char *endp = NULL;
643
644                 if (p[1] < '0' && p[1] > '9')
645                         return 0;
646
647                 lev = (simple_strtoul(&p[1], &endp, 10) & 7);
648                 if (endp == NULL || endp[0] != '>')
649                         return 0;
650                 len = (endp + 1) - p;
651         }
652
653         /* do not accept special char if not asked for */
654         if (sp && !special)
655                 return 0;
656
657         if (special) {
658                 *special = sp;
659                 /* return special char, do not touch level */
660                 if (sp)
661                         return len;
662         }
663
664         if (level)
665                 *level = lev;
666         return len;
667 }
668
669 /*
670  * Call the console drivers, asking them to write out
671  * log_buf[start] to log_buf[end - 1].
672  * The console_lock must be held.
673  */
674 static void call_console_drivers(unsigned start, unsigned end)
675 {
676         unsigned cur_index, start_print;
677         static int msg_level = -1;
678
679         BUG_ON(((int)(start - end)) > 0);
680
681         cur_index = start;
682         start_print = start;
683         while (cur_index != end) {
684                 if (msg_level < 0 && ((end - cur_index) > 2)) {
685                         /* strip log prefix */
686                         cur_index += log_prefix(&LOG_BUF(cur_index), &msg_level, NULL);
687                         start_print = cur_index;
688                 }
689                 while (cur_index != end) {
690                         char c = LOG_BUF(cur_index);
691
692                         cur_index++;
693                         if (c == '\n') {
694                                 if (msg_level < 0) {
695                                         /*
696                                          * printk() has already given us loglevel tags in
697                                          * the buffer.  This code is here in case the
698                                          * log buffer has wrapped right round and scribbled
699                                          * on those tags
700                                          */
701                                         msg_level = default_message_loglevel;
702                                 }
703                                 _call_console_drivers(start_print, cur_index, msg_level);
704                                 msg_level = -1;
705                                 start_print = cur_index;
706                                 break;
707                         }
708                 }
709         }
710         _call_console_drivers(start_print, end, msg_level);
711 }
712
713 static void emit_log_char(char c)
714 {
715         LOG_BUF(log_end) = c;
716         log_end++;
717         if (log_end - log_start > log_buf_len)
718                 log_start = log_end - log_buf_len;
719         if (log_end - con_start > log_buf_len)
720                 con_start = log_end - log_buf_len;
721         if (logged_chars < log_buf_len)
722                 logged_chars++;
723 }
724
725 /*
726  * Zap console related locks when oopsing. Only zap at most once
727  * every 10 seconds, to leave time for slow consoles to print a
728  * full oops.
729  */
730 static void zap_locks(void)
731 {
732         static unsigned long oops_timestamp;
733
734         if (time_after_eq(jiffies, oops_timestamp) &&
735                         !time_after(jiffies, oops_timestamp + 30 * HZ))
736                 return;
737
738         oops_timestamp = jiffies;
739
740         /* If a crash is occurring, make sure we can't deadlock */
741         spin_lock_init(&logbuf_lock);
742         /* And make sure that we print immediately */
743         sema_init(&console_sem, 1);
744 }
745
746 #if defined(CONFIG_PRINTK_TIME)
747 static int printk_time = 1;
748 #else
749 static int printk_time = 0;
750 #endif
751 module_param_named(time, printk_time, bool, S_IRUGO | S_IWUSR);
752
753 /* Check if we have any console registered that can be called early in boot. */
754 static int have_callable_console(void)
755 {
756         struct console *con;
757
758         for_each_console(con)
759                 if (con->flags & CON_ANYTIME)
760                         return 1;
761
762         return 0;
763 }
764
765 /**
766  * printk - print a kernel message
767  * @fmt: format string
768  *
769  * This is printk().  It can be called from any context.  We want it to work.
770  *
771  * We try to grab the console_lock.  If we succeed, it's easy - we log the output and
772  * call the console drivers.  If we fail to get the semaphore we place the output
773  * into the log buffer and return.  The current holder of the console_sem will
774  * notice the new output in console_unlock(); and will send it to the
775  * consoles before releasing the lock.
776  *
777  * One effect of this deferred printing is that code which calls printk() and
778  * then changes console_loglevel may break. This is because console_loglevel
779  * is inspected when the actual printing occurs.
780  *
781  * See also:
782  * printf(3)
783  *
784  * See the vsnprintf() documentation for format string extensions over C99.
785  */
786
787 asmlinkage int printk(const char *fmt, ...)
788 {
789         va_list args;
790         int r;
791
792 #ifdef CONFIG_KGDB_KDB
793         if (unlikely(kdb_trap_printk)) {
794                 va_start(args, fmt);
795                 r = vkdb_printf(fmt, args);
796                 va_end(args);
797                 return r;
798         }
799 #endif
800         va_start(args, fmt);
801         r = vprintk(fmt, args);
802         va_end(args);
803
804         return r;
805 }
806
807 /* cpu currently holding logbuf_lock */
808 static volatile unsigned int printk_cpu = UINT_MAX;
809
810 /*
811  * Can we actually use the console at this time on this cpu?
812  *
813  * Console drivers may assume that per-cpu resources have
814  * been allocated. So unless they're explicitly marked as
815  * being able to cope (CON_ANYTIME) don't call them until
816  * this CPU is officially up.
817  */
818 static inline int can_use_console(unsigned int cpu)
819 {
820         return cpu_online(cpu) || have_callable_console();
821 }
822
823 /*
824  * Try to get console ownership to actually show the kernel
825  * messages from a 'printk'. Return true (and with the
826  * console_lock held, and 'console_locked' set) if it
827  * is successful, false otherwise.
828  *
829  * This gets called with the 'logbuf_lock' spinlock held and
830  * interrupts disabled. It should return with 'lockbuf_lock'
831  * released but interrupts still disabled.
832  */
833 static int console_trylock_for_printk(unsigned int cpu)
834         __releases(&logbuf_lock)
835 {
836         int retval = 0;
837
838         if (console_trylock()) {
839                 retval = 1;
840
841                 /*
842                  * If we can't use the console, we need to release
843                  * the console semaphore by hand to avoid flushing
844                  * the buffer. We need to hold the console semaphore
845                  * in order to do this test safely.
846                  */
847                 if (!can_use_console(cpu)) {
848                         console_locked = 0;
849                         up(&console_sem);
850                         retval = 0;
851                 }
852         }
853         printk_cpu = UINT_MAX;
854         spin_unlock(&logbuf_lock);
855         return retval;
856 }
857 static const char recursion_bug_msg [] =
858                 KERN_CRIT "BUG: recent printk recursion!\n";
859 static int recursion_bug;
860 static int new_text_line = 1;
861 static char printk_buf[1024];
862
863 int printk_delay_msec __read_mostly;
864
865 static inline void printk_delay(void)
866 {
867         if (unlikely(printk_delay_msec)) {
868                 int m = printk_delay_msec;
869
870                 while (m--) {
871                         mdelay(1);
872                         touch_nmi_watchdog();
873                 }
874         }
875 }
876
877 asmlinkage int vprintk(const char *fmt, va_list args)
878 {
879         int printed_len = 0;
880         int current_log_level = default_message_loglevel;
881         unsigned long flags;
882         int this_cpu;
883         char *p;
884         size_t plen;
885         char special;
886
887         boot_delay_msec();
888         printk_delay();
889
890         preempt_disable();
891         /* This stops the holder of console_sem just where we want him */
892         raw_local_irq_save(flags);
893         this_cpu = smp_processor_id();
894
895         /*
896          * Ouch, printk recursed into itself!
897          */
898         if (unlikely(printk_cpu == this_cpu)) {
899                 /*
900                  * If a crash is occurring during printk() on this CPU,
901                  * then try to get the crash message out but make sure
902                  * we can't deadlock. Otherwise just return to avoid the
903                  * recursion and return - but flag the recursion so that
904                  * it can be printed at the next appropriate moment:
905                  */
906                 if (!oops_in_progress) {
907                         recursion_bug = 1;
908                         goto out_restore_irqs;
909                 }
910                 zap_locks();
911         }
912
913         lockdep_off();
914         spin_lock(&logbuf_lock);
915         printk_cpu = this_cpu;
916
917         if (recursion_bug) {
918                 recursion_bug = 0;
919                 strcpy(printk_buf, recursion_bug_msg);
920                 printed_len = strlen(recursion_bug_msg);
921         }
922         /* Emit the output into the temporary buffer */
923         printed_len += vscnprintf(printk_buf + printed_len,
924                                   sizeof(printk_buf) - printed_len, fmt, args);
925
926 #ifdef  CONFIG_DEBUG_LL
927         printascii(printk_buf);
928 #endif
929
930         p = printk_buf;
931
932         /* Read log level and handle special printk prefix */
933         plen = log_prefix(p, &current_log_level, &special);
934         if (plen) {
935                 p += plen;
936
937                 switch (special) {
938                 case 'c': /* Strip <c> KERN_CONT, continue line */
939                         plen = 0;
940                         break;
941                 case 'd': /* Strip <d> KERN_DEFAULT, start new line */
942                         plen = 0;
943                 default:
944                         if (!new_text_line) {
945                                 emit_log_char('\n');
946                                 new_text_line = 1;
947                         }
948                 }
949         }
950
951         /*
952          * Copy the output into log_buf. If the caller didn't provide
953          * the appropriate log prefix, we insert them here
954          */
955         for (; *p; p++) {
956                 if (new_text_line) {
957                         new_text_line = 0;
958
959                         if (plen) {
960                                 /* Copy original log prefix */
961                                 int i;
962
963                                 for (i = 0; i < plen; i++)
964                                         emit_log_char(printk_buf[i]);
965                                 printed_len += plen;
966                         } else {
967                                 /* Add log prefix */
968                                 emit_log_char('<');
969                                 emit_log_char(current_log_level + '0');
970                                 emit_log_char('>');
971                                 printed_len += 3;
972                         }
973
974                         if (printk_time) {
975                                 /* Add the current time stamp */
976                                 char tbuf[50], *tp;
977                                 unsigned tlen;
978                                 unsigned long long t;
979                                 unsigned long nanosec_rem;
980
981                                 t = cpu_clock(printk_cpu);
982                                 nanosec_rem = do_div(t, 1000000000);
983                                 tlen = sprintf(tbuf, "[%5lu.%06lu] ",
984                                                 (unsigned long) t,
985                                                 nanosec_rem / 1000);
986
987                                 for (tp = tbuf; tp < tbuf + tlen; tp++)
988                                         emit_log_char(*tp);
989                                 printed_len += tlen;
990                         }
991
992                         if (!*p)
993                                 break;
994                 }
995
996                 emit_log_char(*p);
997                 if (*p == '\n')
998                         new_text_line = 1;
999         }
1000
1001         /*
1002          * Try to acquire and then immediately release the
1003          * console semaphore. The release will do all the
1004          * actual magic (print out buffers, wake up klogd,
1005          * etc). 
1006          *
1007          * The console_trylock_for_printk() function
1008          * will release 'logbuf_lock' regardless of whether it
1009          * actually gets the semaphore or not.
1010          */
1011         if (console_trylock_for_printk(this_cpu))
1012                 console_unlock();
1013
1014         lockdep_on();
1015 out_restore_irqs:
1016         raw_local_irq_restore(flags);
1017
1018         preempt_enable();
1019         return printed_len;
1020 }
1021 EXPORT_SYMBOL(printk);
1022 EXPORT_SYMBOL(vprintk);
1023
1024 #ifdef CONFIG_RK29_LAST_LOG
1025 void switch_log_buf(char *new_log_buf, int size)
1026 {
1027         unsigned long flags;
1028
1029         if (!new_log_buf || log_buf_len > size)
1030                 return;
1031
1032         spin_lock_irqsave(&logbuf_lock, flags);
1033         memcpy(new_log_buf, log_buf, min(log_buf_len, size));
1034         log_buf = new_log_buf;
1035         log_buf_len = size;
1036         spin_unlock_irqrestore(&logbuf_lock, flags);
1037 }
1038 #endif /* CONFIG_RK29_LAST_LOG */
1039 #else
1040
1041 static void call_console_drivers(unsigned start, unsigned end)
1042 {
1043 }
1044
1045 #endif
1046
1047 static int __add_preferred_console(char *name, int idx, char *options,
1048                                    char *brl_options)
1049 {
1050         struct console_cmdline *c;
1051         int i;
1052
1053         /*
1054          *      See if this tty is not yet registered, and
1055          *      if we have a slot free.
1056          */
1057         for (i = 0; i < MAX_CMDLINECONSOLES && console_cmdline[i].name[0]; i++)
1058                 if (strcmp(console_cmdline[i].name, name) == 0 &&
1059                           console_cmdline[i].index == idx) {
1060                                 if (!brl_options)
1061                                         selected_console = i;
1062                                 return 0;
1063                 }
1064         if (i == MAX_CMDLINECONSOLES)
1065                 return -E2BIG;
1066         if (!brl_options)
1067                 selected_console = i;
1068         c = &console_cmdline[i];
1069         strlcpy(c->name, name, sizeof(c->name));
1070         c->options = options;
1071 #ifdef CONFIG_A11Y_BRAILLE_CONSOLE
1072         c->brl_options = brl_options;
1073 #endif
1074         c->index = idx;
1075         return 0;
1076 }
1077 /*
1078  * Set up a list of consoles.  Called from init/main.c
1079  */
1080 static int __init console_setup(char *str)
1081 {
1082         char buf[sizeof(console_cmdline[0].name) + 4]; /* 4 for index */
1083         char *s, *options, *brl_options = NULL;
1084         int idx;
1085
1086 #ifdef CONFIG_A11Y_BRAILLE_CONSOLE
1087         if (!memcmp(str, "brl,", 4)) {
1088                 brl_options = "";
1089                 str += 4;
1090         } else if (!memcmp(str, "brl=", 4)) {
1091                 brl_options = str + 4;
1092                 str = strchr(brl_options, ',');
1093                 if (!str) {
1094                         printk(KERN_ERR "need port name after brl=\n");
1095                         return 1;
1096                 }
1097                 *(str++) = 0;
1098         }
1099 #endif
1100
1101         /*
1102          * Decode str into name, index, options.
1103          */
1104         if (str[0] >= '0' && str[0] <= '9') {
1105                 strcpy(buf, "ttyS");
1106                 strncpy(buf + 4, str, sizeof(buf) - 5);
1107         } else {
1108                 strncpy(buf, str, sizeof(buf) - 1);
1109         }
1110         buf[sizeof(buf) - 1] = 0;
1111         if ((options = strchr(str, ',')) != NULL)
1112                 *(options++) = 0;
1113 #ifdef __sparc__
1114         if (!strcmp(str, "ttya"))
1115                 strcpy(buf, "ttyS0");
1116         if (!strcmp(str, "ttyb"))
1117                 strcpy(buf, "ttyS1");
1118 #endif
1119         for (s = buf; *s; s++)
1120                 if ((*s >= '0' && *s <= '9') || *s == ',')
1121                         break;
1122         idx = simple_strtoul(s, NULL, 10);
1123         *s = 0;
1124
1125         __add_preferred_console(buf, idx, options, brl_options);
1126         console_set_on_cmdline = 1;
1127         return 1;
1128 }
1129 __setup("console=", console_setup);
1130
1131 /**
1132  * add_preferred_console - add a device to the list of preferred consoles.
1133  * @name: device name
1134  * @idx: device index
1135  * @options: options for this console
1136  *
1137  * The last preferred console added will be used for kernel messages
1138  * and stdin/out/err for init.  Normally this is used by console_setup
1139  * above to handle user-supplied console arguments; however it can also
1140  * be used by arch-specific code either to override the user or more
1141  * commonly to provide a default console (ie from PROM variables) when
1142  * the user has not supplied one.
1143  */
1144 int add_preferred_console(char *name, int idx, char *options)
1145 {
1146         return __add_preferred_console(name, idx, options, NULL);
1147 }
1148
1149 int update_console_cmdline(char *name, int idx, char *name_new, int idx_new, char *options)
1150 {
1151         struct console_cmdline *c;
1152         int i;
1153
1154         for (i = 0; i < MAX_CMDLINECONSOLES && console_cmdline[i].name[0]; i++)
1155                 if (strcmp(console_cmdline[i].name, name) == 0 &&
1156                           console_cmdline[i].index == idx) {
1157                                 c = &console_cmdline[i];
1158                                 strlcpy(c->name, name_new, sizeof(c->name));
1159                                 c->name[sizeof(c->name) - 1] = 0;
1160                                 c->options = options;
1161                                 c->index = idx_new;
1162                                 return i;
1163                 }
1164         /* not found */
1165         return -1;
1166 }
1167
1168 int console_suspend_enabled = 1;
1169 EXPORT_SYMBOL(console_suspend_enabled);
1170
1171 static int __init console_suspend_disable(char *str)
1172 {
1173         console_suspend_enabled = 0;
1174         return 1;
1175 }
1176 __setup("no_console_suspend", console_suspend_disable);
1177
1178 /**
1179  * suspend_console - suspend the console subsystem
1180  *
1181  * This disables printk() while we go into suspend states
1182  */
1183 void suspend_console(void)
1184 {
1185         if (!console_suspend_enabled)
1186                 return;
1187         printk("Suspending console(s) (use no_console_suspend to debug)\n");
1188         console_lock();
1189         console_suspended = 1;
1190         up(&console_sem);
1191 }
1192
1193 void resume_console(void)
1194 {
1195         if (!console_suspend_enabled)
1196                 return;
1197         down(&console_sem);
1198         console_suspended = 0;
1199         console_unlock();
1200 }
1201
1202 /**
1203  * console_cpu_notify - print deferred console messages after CPU hotplug
1204  * @self: notifier struct
1205  * @action: CPU hotplug event
1206  * @hcpu: unused
1207  *
1208  * If printk() is called from a CPU that is not online yet, the messages
1209  * will be spooled but will not show up on the console.  This function is
1210  * called when a new CPU comes online (or fails to come up), and ensures
1211  * that any such output gets printed.
1212  */
1213 static int __cpuinit console_cpu_notify(struct notifier_block *self,
1214         unsigned long action, void *hcpu)
1215 {
1216         switch (action) {
1217         case CPU_ONLINE:
1218         case CPU_DEAD:
1219         case CPU_DOWN_FAILED:
1220         case CPU_UP_CANCELED:
1221                 console_lock();
1222                 console_unlock();
1223         }
1224         return NOTIFY_OK;
1225 }
1226
1227 /**
1228  * console_lock - lock the console system for exclusive use.
1229  *
1230  * Acquires a lock which guarantees that the caller has
1231  * exclusive access to the console system and the console_drivers list.
1232  *
1233  * Can sleep, returns nothing.
1234  */
1235 void console_lock(void)
1236 {
1237         BUG_ON(in_interrupt());
1238         down(&console_sem);
1239         if (console_suspended)
1240                 return;
1241         console_locked = 1;
1242         console_may_schedule = 1;
1243 }
1244 EXPORT_SYMBOL(console_lock);
1245
1246 /**
1247  * console_trylock - try to lock the console system for exclusive use.
1248  *
1249  * Tried to acquire a lock which guarantees that the caller has
1250  * exclusive access to the console system and the console_drivers list.
1251  *
1252  * returns 1 on success, and 0 on failure to acquire the lock.
1253  */
1254 int console_trylock(void)
1255 {
1256         if (down_trylock(&console_sem))
1257                 return 0;
1258         if (console_suspended) {
1259                 up(&console_sem);
1260                 return 0;
1261         }
1262         console_locked = 1;
1263         console_may_schedule = 0;
1264         return 1;
1265 }
1266 EXPORT_SYMBOL(console_trylock);
1267
1268 int is_console_locked(void)
1269 {
1270         return console_locked;
1271 }
1272
1273 static DEFINE_PER_CPU(int, printk_pending);
1274
1275 void printk_tick(void)
1276 {
1277         if (__this_cpu_read(printk_pending)) {
1278                 __this_cpu_write(printk_pending, 0);
1279                 wake_up_interruptible(&log_wait);
1280         }
1281 }
1282
1283 int printk_needs_cpu(int cpu)
1284 {
1285         if (cpu_is_offline(cpu))
1286                 printk_tick();
1287         return __this_cpu_read(printk_pending);
1288 }
1289
1290 void wake_up_klogd(void)
1291 {
1292         if (waitqueue_active(&log_wait))
1293                 this_cpu_write(printk_pending, 1);
1294 }
1295
1296 /**
1297  * console_unlock - unlock the console system
1298  *
1299  * Releases the console_lock which the caller holds on the console system
1300  * and the console driver list.
1301  *
1302  * While the console_lock was held, console output may have been buffered
1303  * by printk().  If this is the case, console_unlock(); emits
1304  * the output prior to releasing the lock.
1305  *
1306  * If there is output waiting for klogd, we wake it up.
1307  *
1308  * console_unlock(); may be called from any context.
1309  */
1310 void console_unlock(void)
1311 {
1312         unsigned long flags;
1313         unsigned _con_start, _log_end;
1314         unsigned wake_klogd = 0;
1315
1316         if (console_suspended) {
1317                 up(&console_sem);
1318                 return;
1319         }
1320
1321         console_may_schedule = 0;
1322
1323         for ( ; ; ) {
1324                 spin_lock_irqsave(&logbuf_lock, flags);
1325                 wake_klogd |= log_start - log_end;
1326                 if (con_start == log_end)
1327                         break;                  /* Nothing to print */
1328                 _con_start = con_start;
1329                 _log_end = log_end;
1330                 con_start = log_end;            /* Flush */
1331                 spin_unlock(&logbuf_lock);
1332                 stop_critical_timings();        /* don't trace print latency */
1333                 call_console_drivers(_con_start, _log_end);
1334                 start_critical_timings();
1335                 local_irq_restore(flags);
1336         }
1337         console_locked = 0;
1338
1339         /* Release the exclusive_console once it is used */
1340         if (unlikely(exclusive_console))
1341                 exclusive_console = NULL;
1342
1343         up(&console_sem);
1344         spin_unlock_irqrestore(&logbuf_lock, flags);
1345         if (wake_klogd)
1346                 wake_up_klogd();
1347 }
1348 EXPORT_SYMBOL(console_unlock);
1349
1350 /**
1351  * console_conditional_schedule - yield the CPU if required
1352  *
1353  * If the console code is currently allowed to sleep, and
1354  * if this CPU should yield the CPU to another task, do
1355  * so here.
1356  *
1357  * Must be called within console_lock();.
1358  */
1359 void __sched console_conditional_schedule(void)
1360 {
1361         if (console_may_schedule)
1362                 cond_resched();
1363 }
1364 EXPORT_SYMBOL(console_conditional_schedule);
1365
1366 void console_unblank(void)
1367 {
1368         struct console *c;
1369
1370         /*
1371          * console_unblank can no longer be called in interrupt context unless
1372          * oops_in_progress is set to 1..
1373          */
1374         if (oops_in_progress) {
1375                 if (down_trylock(&console_sem) != 0)
1376                         return;
1377         } else
1378                 console_lock();
1379
1380         console_locked = 1;
1381         console_may_schedule = 0;
1382         for_each_console(c)
1383                 if ((c->flags & CON_ENABLED) && c->unblank)
1384                         c->unblank();
1385         console_unlock();
1386 }
1387
1388 /*
1389  * Return the console tty driver structure and its associated index
1390  */
1391 struct tty_driver *console_device(int *index)
1392 {
1393         struct console *c;
1394         struct tty_driver *driver = NULL;
1395
1396         console_lock();
1397         for_each_console(c) {
1398                 if (!c->device)
1399                         continue;
1400                 driver = c->device(c, index);
1401                 if (driver)
1402                         break;
1403         }
1404         console_unlock();
1405         return driver;
1406 }
1407
1408 /*
1409  * Prevent further output on the passed console device so that (for example)
1410  * serial drivers can disable console output before suspending a port, and can
1411  * re-enable output afterwards.
1412  */
1413 void console_stop(struct console *console)
1414 {
1415         console_lock();
1416         console->flags &= ~CON_ENABLED;
1417         console_unlock();
1418 }
1419 EXPORT_SYMBOL(console_stop);
1420
1421 void console_start(struct console *console)
1422 {
1423         console_lock();
1424         console->flags |= CON_ENABLED;
1425         console_unlock();
1426 }
1427 EXPORT_SYMBOL(console_start);
1428
1429 static int __read_mostly keep_bootcon;
1430
1431 static int __init keep_bootcon_setup(char *str)
1432 {
1433         keep_bootcon = 1;
1434         printk(KERN_INFO "debug: skip boot console de-registration.\n");
1435
1436         return 0;
1437 }
1438
1439 early_param("keep_bootcon", keep_bootcon_setup);
1440
1441 /*
1442  * The console driver calls this routine during kernel initialization
1443  * to register the console printing procedure with printk() and to
1444  * print any messages that were printed by the kernel before the
1445  * console driver was initialized.
1446  *
1447  * This can happen pretty early during the boot process (because of
1448  * early_printk) - sometimes before setup_arch() completes - be careful
1449  * of what kernel features are used - they may not be initialised yet.
1450  *
1451  * There are two types of consoles - bootconsoles (early_printk) and
1452  * "real" consoles (everything which is not a bootconsole) which are
1453  * handled differently.
1454  *  - Any number of bootconsoles can be registered at any time.
1455  *  - As soon as a "real" console is registered, all bootconsoles
1456  *    will be unregistered automatically.
1457  *  - Once a "real" console is registered, any attempt to register a
1458  *    bootconsoles will be rejected
1459  */
1460 void register_console(struct console *newcon)
1461 {
1462         int i;
1463         unsigned long flags;
1464         struct console *bcon = NULL;
1465
1466         /*
1467          * before we register a new CON_BOOT console, make sure we don't
1468          * already have a valid console
1469          */
1470         if (console_drivers && newcon->flags & CON_BOOT) {
1471                 /* find the last or real console */
1472                 for_each_console(bcon) {
1473                         if (!(bcon->flags & CON_BOOT)) {
1474                                 printk(KERN_INFO "Too late to register bootconsole %s%d\n",
1475                                         newcon->name, newcon->index);
1476                                 return;
1477                         }
1478                 }
1479         }
1480
1481         if (console_drivers && console_drivers->flags & CON_BOOT)
1482                 bcon = console_drivers;
1483
1484         if (preferred_console < 0 || bcon || !console_drivers)
1485                 preferred_console = selected_console;
1486
1487         if (newcon->early_setup)
1488                 newcon->early_setup();
1489
1490         /*
1491          *      See if we want to use this console driver. If we
1492          *      didn't select a console we take the first one
1493          *      that registers here.
1494          */
1495         if (preferred_console < 0) {
1496                 if (newcon->index < 0)
1497                         newcon->index = 0;
1498                 if (newcon->setup == NULL ||
1499                     newcon->setup(newcon, NULL) == 0) {
1500                         newcon->flags |= CON_ENABLED;
1501                         if (newcon->device) {
1502                                 newcon->flags |= CON_CONSDEV;
1503                                 preferred_console = 0;
1504                         }
1505                 }
1506         }
1507
1508         /*
1509          *      See if this console matches one we selected on
1510          *      the command line.
1511          */
1512         for (i = 0; i < MAX_CMDLINECONSOLES && console_cmdline[i].name[0];
1513                         i++) {
1514                 if (strcmp(console_cmdline[i].name, newcon->name) != 0)
1515                         continue;
1516                 if (newcon->index >= 0 &&
1517                     newcon->index != console_cmdline[i].index)
1518                         continue;
1519                 if (newcon->index < 0)
1520                         newcon->index = console_cmdline[i].index;
1521 #ifdef CONFIG_A11Y_BRAILLE_CONSOLE
1522                 if (console_cmdline[i].brl_options) {
1523                         newcon->flags |= CON_BRL;
1524                         braille_register_console(newcon,
1525                                         console_cmdline[i].index,
1526                                         console_cmdline[i].options,
1527                                         console_cmdline[i].brl_options);
1528                         return;
1529                 }
1530 #endif
1531                 if (newcon->setup &&
1532                     newcon->setup(newcon, console_cmdline[i].options) != 0)
1533                         break;
1534                 newcon->flags |= CON_ENABLED;
1535                 newcon->index = console_cmdline[i].index;
1536                 if (i == selected_console) {
1537                         newcon->flags |= CON_CONSDEV;
1538                         preferred_console = selected_console;
1539                 }
1540                 break;
1541         }
1542
1543         if (!(newcon->flags & CON_ENABLED))
1544                 return;
1545
1546         /*
1547          * If we have a bootconsole, and are switching to a real console,
1548          * don't print everything out again, since when the boot console, and
1549          * the real console are the same physical device, it's annoying to
1550          * see the beginning boot messages twice
1551          */
1552         if (bcon && ((newcon->flags & (CON_CONSDEV | CON_BOOT)) == CON_CONSDEV))
1553                 newcon->flags &= ~CON_PRINTBUFFER;
1554
1555         /*
1556          *      Put this console in the list - keep the
1557          *      preferred driver at the head of the list.
1558          */
1559         console_lock();
1560         if ((newcon->flags & CON_CONSDEV) || console_drivers == NULL) {
1561                 newcon->next = console_drivers;
1562                 console_drivers = newcon;
1563                 if (newcon->next)
1564                         newcon->next->flags &= ~CON_CONSDEV;
1565         } else {
1566                 newcon->next = console_drivers->next;
1567                 console_drivers->next = newcon;
1568         }
1569         if (newcon->flags & CON_PRINTBUFFER) {
1570                 /*
1571                  * console_unlock(); will print out the buffered messages
1572                  * for us.
1573                  */
1574                 spin_lock_irqsave(&logbuf_lock, flags);
1575                 con_start = log_start;
1576                 spin_unlock_irqrestore(&logbuf_lock, flags);
1577                 /*
1578                  * We're about to replay the log buffer.  Only do this to the
1579                  * just-registered console to avoid excessive message spam to
1580                  * the already-registered consoles.
1581                  */
1582                 exclusive_console = newcon;
1583         }
1584         console_unlock();
1585         console_sysfs_notify();
1586
1587         /*
1588          * By unregistering the bootconsoles after we enable the real console
1589          * we get the "console xxx enabled" message on all the consoles -
1590          * boot consoles, real consoles, etc - this is to ensure that end
1591          * users know there might be something in the kernel's log buffer that
1592          * went to the bootconsole (that they do not see on the real console)
1593          */
1594         if (bcon &&
1595             ((newcon->flags & (CON_CONSDEV | CON_BOOT)) == CON_CONSDEV) &&
1596             !keep_bootcon) {
1597                 /* we need to iterate through twice, to make sure we print
1598                  * everything out, before we unregister the console(s)
1599                  */
1600                 printk(KERN_INFO "console [%s%d] enabled, bootconsole disabled\n",
1601                         newcon->name, newcon->index);
1602                 for_each_console(bcon)
1603                         if (bcon->flags & CON_BOOT)
1604                                 unregister_console(bcon);
1605         } else {
1606                 printk(KERN_INFO "%sconsole [%s%d] enabled\n",
1607                         (newcon->flags & CON_BOOT) ? "boot" : "" ,
1608                         newcon->name, newcon->index);
1609         }
1610 }
1611 EXPORT_SYMBOL(register_console);
1612
1613 int unregister_console(struct console *console)
1614 {
1615         struct console *a, *b;
1616         int res = 1;
1617
1618 #ifdef CONFIG_A11Y_BRAILLE_CONSOLE
1619         if (console->flags & CON_BRL)
1620                 return braille_unregister_console(console);
1621 #endif
1622
1623         console_lock();
1624         if (console_drivers == console) {
1625                 console_drivers=console->next;
1626                 res = 0;
1627         } else if (console_drivers) {
1628                 for (a=console_drivers->next, b=console_drivers ;
1629                      a; b=a, a=b->next) {
1630                         if (a == console) {
1631                                 b->next = a->next;
1632                                 res = 0;
1633                                 break;
1634                         }
1635                 }
1636         }
1637
1638         /*
1639          * If this isn't the last console and it has CON_CONSDEV set, we
1640          * need to set it on the next preferred console.
1641          */
1642         if (console_drivers != NULL && console->flags & CON_CONSDEV)
1643                 console_drivers->flags |= CON_CONSDEV;
1644
1645         console_unlock();
1646         console_sysfs_notify();
1647         return res;
1648 }
1649 EXPORT_SYMBOL(unregister_console);
1650
1651 static int __init printk_late_init(void)
1652 {
1653         struct console *con;
1654
1655         for_each_console(con) {
1656                 if (!keep_bootcon && con->flags & CON_BOOT) {
1657                         printk(KERN_INFO "turn off boot console %s%d\n",
1658                                 con->name, con->index);
1659                         unregister_console(con);
1660                 }
1661         }
1662         hotcpu_notifier(console_cpu_notify, 0);
1663         return 0;
1664 }
1665 late_initcall(printk_late_init);
1666
1667 #if defined CONFIG_PRINTK
1668
1669 /*
1670  * printk rate limiting, lifted from the networking subsystem.
1671  *
1672  * This enforces a rate limit: not more than 10 kernel messages
1673  * every 5s to make a denial-of-service attack impossible.
1674  */
1675 DEFINE_RATELIMIT_STATE(printk_ratelimit_state, 5 * HZ, 10);
1676
1677 int __printk_ratelimit(const char *func)
1678 {
1679         return ___ratelimit(&printk_ratelimit_state, func);
1680 }
1681 EXPORT_SYMBOL(__printk_ratelimit);
1682
1683 /**
1684  * printk_timed_ratelimit - caller-controlled printk ratelimiting
1685  * @caller_jiffies: pointer to caller's state
1686  * @interval_msecs: minimum interval between prints
1687  *
1688  * printk_timed_ratelimit() returns true if more than @interval_msecs
1689  * milliseconds have elapsed since the last time printk_timed_ratelimit()
1690  * returned true.
1691  */
1692 bool printk_timed_ratelimit(unsigned long *caller_jiffies,
1693                         unsigned int interval_msecs)
1694 {
1695         if (*caller_jiffies == 0
1696                         || !time_in_range(jiffies, *caller_jiffies,
1697                                         *caller_jiffies
1698                                         + msecs_to_jiffies(interval_msecs))) {
1699                 *caller_jiffies = jiffies;
1700                 return true;
1701         }
1702         return false;
1703 }
1704 EXPORT_SYMBOL(printk_timed_ratelimit);
1705
1706 static DEFINE_SPINLOCK(dump_list_lock);
1707 static LIST_HEAD(dump_list);
1708
1709 /**
1710  * kmsg_dump_register - register a kernel log dumper.
1711  * @dumper: pointer to the kmsg_dumper structure
1712  *
1713  * Adds a kernel log dumper to the system. The dump callback in the
1714  * structure will be called when the kernel oopses or panics and must be
1715  * set. Returns zero on success and %-EINVAL or %-EBUSY otherwise.
1716  */
1717 int kmsg_dump_register(struct kmsg_dumper *dumper)
1718 {
1719         unsigned long flags;
1720         int err = -EBUSY;
1721
1722         /* The dump callback needs to be set */
1723         if (!dumper->dump)
1724                 return -EINVAL;
1725
1726         spin_lock_irqsave(&dump_list_lock, flags);
1727         /* Don't allow registering multiple times */
1728         if (!dumper->registered) {
1729                 dumper->registered = 1;
1730                 list_add_tail_rcu(&dumper->list, &dump_list);
1731                 err = 0;
1732         }
1733         spin_unlock_irqrestore(&dump_list_lock, flags);
1734
1735         return err;
1736 }
1737 EXPORT_SYMBOL_GPL(kmsg_dump_register);
1738
1739 /**
1740  * kmsg_dump_unregister - unregister a kmsg dumper.
1741  * @dumper: pointer to the kmsg_dumper structure
1742  *
1743  * Removes a dump device from the system. Returns zero on success and
1744  * %-EINVAL otherwise.
1745  */
1746 int kmsg_dump_unregister(struct kmsg_dumper *dumper)
1747 {
1748         unsigned long flags;
1749         int err = -EINVAL;
1750
1751         spin_lock_irqsave(&dump_list_lock, flags);
1752         if (dumper->registered) {
1753                 dumper->registered = 0;
1754                 list_del_rcu(&dumper->list);
1755                 err = 0;
1756         }
1757         spin_unlock_irqrestore(&dump_list_lock, flags);
1758         synchronize_rcu();
1759
1760         return err;
1761 }
1762 EXPORT_SYMBOL_GPL(kmsg_dump_unregister);
1763
1764 /**
1765  * kmsg_dump - dump kernel log to kernel message dumpers.
1766  * @reason: the reason (oops, panic etc) for dumping
1767  *
1768  * Iterate through each of the dump devices and call the oops/panic
1769  * callbacks with the log buffer.
1770  */
1771 void kmsg_dump(enum kmsg_dump_reason reason)
1772 {
1773         unsigned long end;
1774         unsigned chars;
1775         struct kmsg_dumper *dumper;
1776         const char *s1, *s2;
1777         unsigned long l1, l2;
1778         unsigned long flags;
1779
1780         /* Theoretically, the log could move on after we do this, but
1781            there's not a lot we can do about that. The new messages
1782            will overwrite the start of what we dump. */
1783         spin_lock_irqsave(&logbuf_lock, flags);
1784         end = log_end & LOG_BUF_MASK;
1785         chars = logged_chars;
1786         spin_unlock_irqrestore(&logbuf_lock, flags);
1787
1788         if (chars > end) {
1789                 s1 = log_buf + log_buf_len - chars + end;
1790                 l1 = chars - end;
1791
1792                 s2 = log_buf;
1793                 l2 = end;
1794         } else {
1795                 s1 = "";
1796                 l1 = 0;
1797
1798                 s2 = log_buf + end - chars;
1799                 l2 = chars;
1800         }
1801
1802         rcu_read_lock();
1803         list_for_each_entry_rcu(dumper, &dump_list, list)
1804                 dumper->dump(dumper, reason, s1, l1, s2, l2);
1805         rcu_read_unlock();
1806 }
1807 #endif