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