lib/nmi_backtrace: Serialize even messages about idle CPUs
[platform/kernel/linux-rpi.git] / kernel / printk / printk.c
1 // SPDX-License-Identifier: GPL-2.0-only
2 /*
3  *  linux/kernel/printk.c
4  *
5  *  Copyright (C) 1991, 1992  Linus Torvalds
6  *
7  * Modified to make sys_syslog() more flexible: added commands to
8  * return the last 4k of kernel messages, regardless of whether
9  * they've been read or not.  Added option to suppress kernel printk's
10  * to the console.  Added hook for sending the console messages
11  * elsewhere, in preparation for a serial line console (someday).
12  * Ted Ts'o, 2/11/93.
13  * Modified for sysctl support, 1/8/97, Chris Horn.
14  * Fixed SMP synchronization, 08/08/99, Manfred Spraul
15  *     manfred@colorfullife.com
16  * Rewrote bits to get rid of console_lock
17  *      01Mar01 Andrew Morton
18  */
19
20 #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
21
22 #include <linux/kernel.h>
23 #include <linux/mm.h>
24 #include <linux/tty.h>
25 #include <linux/tty_driver.h>
26 #include <linux/console.h>
27 #include <linux/init.h>
28 #include <linux/jiffies.h>
29 #include <linux/nmi.h>
30 #include <linux/module.h>
31 #include <linux/moduleparam.h>
32 #include <linux/delay.h>
33 #include <linux/smp.h>
34 #include <linux/security.h>
35 #include <linux/memblock.h>
36 #include <linux/syscalls.h>
37 #include <linux/crash_core.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/rculist.h>
43 #include <linux/poll.h>
44 #include <linux/irq_work.h>
45 #include <linux/ctype.h>
46 #include <linux/uio.h>
47 #include <linux/sched/clock.h>
48 #include <linux/sched/debug.h>
49 #include <linux/sched/task_stack.h>
50
51 #include <linux/uaccess.h>
52 #include <asm/sections.h>
53
54 #include <trace/events/initcall.h>
55 #define CREATE_TRACE_POINTS
56 #include <trace/events/printk.h>
57
58 #include "printk_ringbuffer.h"
59 #include "console_cmdline.h"
60 #include "braille.h"
61 #include "internal.h"
62
63 int console_printk[4] = {
64         CONSOLE_LOGLEVEL_DEFAULT,       /* console_loglevel */
65         MESSAGE_LOGLEVEL_DEFAULT,       /* default_message_loglevel */
66         CONSOLE_LOGLEVEL_MIN,           /* minimum_console_loglevel */
67         CONSOLE_LOGLEVEL_DEFAULT,       /* default_console_loglevel */
68 };
69 EXPORT_SYMBOL_GPL(console_printk);
70
71 atomic_t ignore_console_lock_warning __read_mostly = ATOMIC_INIT(0);
72 EXPORT_SYMBOL(ignore_console_lock_warning);
73
74 /*
75  * Low level drivers may need that to know if they can schedule in
76  * their unblank() callback or not. So let's export it.
77  */
78 int oops_in_progress;
79 EXPORT_SYMBOL(oops_in_progress);
80
81 /*
82  * console_sem protects the console_drivers list, and also
83  * provides serialisation for access to the entire console
84  * driver system.
85  */
86 static DEFINE_SEMAPHORE(console_sem);
87 struct console *console_drivers;
88 EXPORT_SYMBOL_GPL(console_drivers);
89
90 /*
91  * System may need to suppress printk message under certain
92  * circumstances, like after kernel panic happens.
93  */
94 int __read_mostly suppress_printk;
95
96 #ifdef CONFIG_LOCKDEP
97 static struct lockdep_map console_lock_dep_map = {
98         .name = "console_lock"
99 };
100 #endif
101
102 enum devkmsg_log_bits {
103         __DEVKMSG_LOG_BIT_ON = 0,
104         __DEVKMSG_LOG_BIT_OFF,
105         __DEVKMSG_LOG_BIT_LOCK,
106 };
107
108 enum devkmsg_log_masks {
109         DEVKMSG_LOG_MASK_ON             = BIT(__DEVKMSG_LOG_BIT_ON),
110         DEVKMSG_LOG_MASK_OFF            = BIT(__DEVKMSG_LOG_BIT_OFF),
111         DEVKMSG_LOG_MASK_LOCK           = BIT(__DEVKMSG_LOG_BIT_LOCK),
112 };
113
114 /* Keep both the 'on' and 'off' bits clear, i.e. ratelimit by default: */
115 #define DEVKMSG_LOG_MASK_DEFAULT        0
116
117 static unsigned int __read_mostly devkmsg_log = DEVKMSG_LOG_MASK_DEFAULT;
118
119 static int __control_devkmsg(char *str)
120 {
121         size_t len;
122
123         if (!str)
124                 return -EINVAL;
125
126         len = str_has_prefix(str, "on");
127         if (len) {
128                 devkmsg_log = DEVKMSG_LOG_MASK_ON;
129                 return len;
130         }
131
132         len = str_has_prefix(str, "off");
133         if (len) {
134                 devkmsg_log = DEVKMSG_LOG_MASK_OFF;
135                 return len;
136         }
137
138         len = str_has_prefix(str, "ratelimit");
139         if (len) {
140                 devkmsg_log = DEVKMSG_LOG_MASK_DEFAULT;
141                 return len;
142         }
143
144         return -EINVAL;
145 }
146
147 static int __init control_devkmsg(char *str)
148 {
149         if (__control_devkmsg(str) < 0)
150                 return 1;
151
152         /*
153          * Set sysctl string accordingly:
154          */
155         if (devkmsg_log == DEVKMSG_LOG_MASK_ON)
156                 strcpy(devkmsg_log_str, "on");
157         else if (devkmsg_log == DEVKMSG_LOG_MASK_OFF)
158                 strcpy(devkmsg_log_str, "off");
159         /* else "ratelimit" which is set by default. */
160
161         /*
162          * Sysctl cannot change it anymore. The kernel command line setting of
163          * this parameter is to force the setting to be permanent throughout the
164          * runtime of the system. This is a precation measure against userspace
165          * trying to be a smarta** and attempting to change it up on us.
166          */
167         devkmsg_log |= DEVKMSG_LOG_MASK_LOCK;
168
169         return 0;
170 }
171 __setup("printk.devkmsg=", control_devkmsg);
172
173 char devkmsg_log_str[DEVKMSG_STR_MAX_SIZE] = "ratelimit";
174
175 int devkmsg_sysctl_set_loglvl(struct ctl_table *table, int write,
176                               void *buffer, size_t *lenp, loff_t *ppos)
177 {
178         char old_str[DEVKMSG_STR_MAX_SIZE];
179         unsigned int old;
180         int err;
181
182         if (write) {
183                 if (devkmsg_log & DEVKMSG_LOG_MASK_LOCK)
184                         return -EINVAL;
185
186                 old = devkmsg_log;
187                 strncpy(old_str, devkmsg_log_str, DEVKMSG_STR_MAX_SIZE);
188         }
189
190         err = proc_dostring(table, write, buffer, lenp, ppos);
191         if (err)
192                 return err;
193
194         if (write) {
195                 err = __control_devkmsg(devkmsg_log_str);
196
197                 /*
198                  * Do not accept an unknown string OR a known string with
199                  * trailing crap...
200                  */
201                 if (err < 0 || (err + 1 != *lenp)) {
202
203                         /* ... and restore old setting. */
204                         devkmsg_log = old;
205                         strncpy(devkmsg_log_str, old_str, DEVKMSG_STR_MAX_SIZE);
206
207                         return -EINVAL;
208                 }
209         }
210
211         return 0;
212 }
213
214 /* Number of registered extended console drivers. */
215 static int nr_ext_console_drivers;
216
217 /*
218  * Helper macros to handle lockdep when locking/unlocking console_sem. We use
219  * macros instead of functions so that _RET_IP_ contains useful information.
220  */
221 #define down_console_sem() do { \
222         down(&console_sem);\
223         mutex_acquire(&console_lock_dep_map, 0, 0, _RET_IP_);\
224 } while (0)
225
226 static int __down_trylock_console_sem(unsigned long ip)
227 {
228         int lock_failed;
229         unsigned long flags;
230
231         /*
232          * Here and in __up_console_sem() we need to be in safe mode,
233          * because spindump/WARN/etc from under console ->lock will
234          * deadlock in printk()->down_trylock_console_sem() otherwise.
235          */
236         printk_safe_enter_irqsave(flags);
237         lock_failed = down_trylock(&console_sem);
238         printk_safe_exit_irqrestore(flags);
239
240         if (lock_failed)
241                 return 1;
242         mutex_acquire(&console_lock_dep_map, 0, 1, ip);
243         return 0;
244 }
245 #define down_trylock_console_sem() __down_trylock_console_sem(_RET_IP_)
246
247 static void __up_console_sem(unsigned long ip)
248 {
249         unsigned long flags;
250
251         mutex_release(&console_lock_dep_map, ip);
252
253         printk_safe_enter_irqsave(flags);
254         up(&console_sem);
255         printk_safe_exit_irqrestore(flags);
256 }
257 #define up_console_sem() __up_console_sem(_RET_IP_)
258
259 /*
260  * This is used for debugging the mess that is the VT code by
261  * keeping track if we have the console semaphore held. It's
262  * definitely not the perfect debug tool (we don't know if _WE_
263  * hold it and are racing, but it helps tracking those weird code
264  * paths in the console code where we end up in places I want
265  * locked without the console semaphore held).
266  */
267 static int console_locked, console_suspended;
268
269 /*
270  * If exclusive_console is non-NULL then only this console is to be printed to.
271  */
272 static struct console *exclusive_console;
273
274 /*
275  *      Array of consoles built from command line options (console=)
276  */
277
278 #define MAX_CMDLINECONSOLES 8
279
280 static struct console_cmdline console_cmdline[MAX_CMDLINECONSOLES];
281
282 static int preferred_console = -1;
283 static bool has_preferred_console;
284 int console_set_on_cmdline;
285 EXPORT_SYMBOL(console_set_on_cmdline);
286
287 /* Flag: console code may call schedule() */
288 static int console_may_schedule;
289
290 enum con_msg_format_flags {
291         MSG_FORMAT_DEFAULT      = 0,
292         MSG_FORMAT_SYSLOG       = (1 << 0),
293 };
294
295 static int console_msg_format = MSG_FORMAT_DEFAULT;
296
297 /*
298  * The printk log buffer consists of a sequenced collection of records, each
299  * containing variable length message text. Every record also contains its
300  * own meta-data (@info).
301  *
302  * Every record meta-data carries the timestamp in microseconds, as well as
303  * the standard userspace syslog level and syslog facility. The usual kernel
304  * messages use LOG_KERN; userspace-injected messages always carry a matching
305  * syslog facility, by default LOG_USER. The origin of every message can be
306  * reliably determined that way.
307  *
308  * The human readable log message of a record is available in @text, the
309  * length of the message text in @text_len. The stored message is not
310  * terminated.
311  *
312  * Optionally, a record can carry a dictionary of properties (key/value
313  * pairs), to provide userspace with a machine-readable message context.
314  *
315  * Examples for well-defined, commonly used property names are:
316  *   DEVICE=b12:8               device identifier
317  *                                b12:8         block dev_t
318  *                                c127:3        char dev_t
319  *                                n8            netdev ifindex
320  *                                +sound:card0  subsystem:devname
321  *   SUBSYSTEM=pci              driver-core subsystem name
322  *
323  * Valid characters in property names are [a-zA-Z0-9.-_]. Property names
324  * and values are terminated by a '\0' character.
325  *
326  * Example of record values:
327  *   record.text_buf                = "it's a line" (unterminated)
328  *   record.info.seq                = 56
329  *   record.info.ts_nsec            = 36863
330  *   record.info.text_len           = 11
331  *   record.info.facility           = 0 (LOG_KERN)
332  *   record.info.flags              = 0
333  *   record.info.level              = 3 (LOG_ERR)
334  *   record.info.caller_id          = 299 (task 299)
335  *   record.info.dev_info.subsystem = "pci" (terminated)
336  *   record.info.dev_info.device    = "+pci:0000:00:01.0" (terminated)
337  *
338  * The 'struct printk_info' buffer must never be directly exported to
339  * userspace, it is a kernel-private implementation detail that might
340  * need to be changed in the future, when the requirements change.
341  *
342  * /dev/kmsg exports the structured data in the following line format:
343  *   "<level>,<sequnum>,<timestamp>,<contflag>[,additional_values, ... ];<message text>\n"
344  *
345  * Users of the export format should ignore possible additional values
346  * separated by ',', and find the message after the ';' character.
347  *
348  * The optional key/value pairs are attached as continuation lines starting
349  * with a space character and terminated by a newline. All possible
350  * non-prinatable characters are escaped in the "\xff" notation.
351  */
352
353 enum log_flags {
354         LOG_NEWLINE     = 2,    /* text ended with a newline */
355         LOG_CONT        = 8,    /* text is a fragment of a continuation line */
356 };
357
358 /* syslog_lock protects syslog_* variables and write access to clear_seq. */
359 static DEFINE_MUTEX(syslog_lock);
360
361 #ifdef CONFIG_PRINTK
362 DECLARE_WAIT_QUEUE_HEAD(log_wait);
363 /* All 3 protected by @syslog_lock. */
364 /* the next printk record to read by syslog(READ) or /proc/kmsg */
365 static u64 syslog_seq;
366 static size_t syslog_partial;
367 static bool syslog_time;
368
369 /* All 3 protected by @console_sem. */
370 /* the next printk record to write to the console */
371 static u64 console_seq;
372 static u64 exclusive_console_stop_seq;
373 static unsigned long console_dropped;
374
375 struct latched_seq {
376         seqcount_latch_t        latch;
377         u64                     val[2];
378 };
379
380 /*
381  * The next printk record to read after the last 'clear' command. There are
382  * two copies (updated with seqcount_latch) so that reads can locklessly
383  * access a valid value. Writers are synchronized by @syslog_lock.
384  */
385 static struct latched_seq clear_seq = {
386         .latch          = SEQCNT_LATCH_ZERO(clear_seq.latch),
387         .val[0]         = 0,
388         .val[1]         = 0,
389 };
390
391 #ifdef CONFIG_PRINTK_CALLER
392 #define PREFIX_MAX              48
393 #else
394 #define PREFIX_MAX              32
395 #endif
396
397 /* the maximum size of a formatted record (i.e. with prefix added per line) */
398 #define CONSOLE_LOG_MAX         1024
399
400 /* the maximum size allowed to be reserved for a record */
401 #define LOG_LINE_MAX            (CONSOLE_LOG_MAX - PREFIX_MAX)
402
403 #define LOG_LEVEL(v)            ((v) & 0x07)
404 #define LOG_FACILITY(v)         ((v) >> 3 & 0xff)
405
406 /* record buffer */
407 #define LOG_ALIGN __alignof__(unsigned long)
408 #define __LOG_BUF_LEN (1 << CONFIG_LOG_BUF_SHIFT)
409 #define LOG_BUF_LEN_MAX (u32)(1 << 31)
410 static char __log_buf[__LOG_BUF_LEN] __aligned(LOG_ALIGN);
411 static char *log_buf = __log_buf;
412 static u32 log_buf_len = __LOG_BUF_LEN;
413
414 /*
415  * Define the average message size. This only affects the number of
416  * descriptors that will be available. Underestimating is better than
417  * overestimating (too many available descriptors is better than not enough).
418  */
419 #define PRB_AVGBITS 5   /* 32 character average length */
420
421 #if CONFIG_LOG_BUF_SHIFT <= PRB_AVGBITS
422 #error CONFIG_LOG_BUF_SHIFT value too small.
423 #endif
424 _DEFINE_PRINTKRB(printk_rb_static, CONFIG_LOG_BUF_SHIFT - PRB_AVGBITS,
425                  PRB_AVGBITS, &__log_buf[0]);
426
427 static struct printk_ringbuffer printk_rb_dynamic;
428
429 static struct printk_ringbuffer *prb = &printk_rb_static;
430
431 /*
432  * We cannot access per-CPU data (e.g. per-CPU flush irq_work) before
433  * per_cpu_areas are initialised. This variable is set to true when
434  * it's safe to access per-CPU data.
435  */
436 static bool __printk_percpu_data_ready __read_mostly;
437
438 bool printk_percpu_data_ready(void)
439 {
440         return __printk_percpu_data_ready;
441 }
442
443 /* Must be called under syslog_lock. */
444 static void latched_seq_write(struct latched_seq *ls, u64 val)
445 {
446         raw_write_seqcount_latch(&ls->latch);
447         ls->val[0] = val;
448         raw_write_seqcount_latch(&ls->latch);
449         ls->val[1] = val;
450 }
451
452 /* Can be called from any context. */
453 static u64 latched_seq_read_nolock(struct latched_seq *ls)
454 {
455         unsigned int seq;
456         unsigned int idx;
457         u64 val;
458
459         do {
460                 seq = raw_read_seqcount_latch(&ls->latch);
461                 idx = seq & 0x1;
462                 val = ls->val[idx];
463         } while (read_seqcount_latch_retry(&ls->latch, seq));
464
465         return val;
466 }
467
468 /* Return log buffer address */
469 char *log_buf_addr_get(void)
470 {
471         return log_buf;
472 }
473
474 /* Return log buffer size */
475 u32 log_buf_len_get(void)
476 {
477         return log_buf_len;
478 }
479
480 /*
481  * Define how much of the log buffer we could take at maximum. The value
482  * must be greater than two. Note that only half of the buffer is available
483  * when the index points to the middle.
484  */
485 #define MAX_LOG_TAKE_PART 4
486 static const char trunc_msg[] = "<truncated>";
487
488 static void truncate_msg(u16 *text_len, u16 *trunc_msg_len)
489 {
490         /*
491          * The message should not take the whole buffer. Otherwise, it might
492          * get removed too soon.
493          */
494         u32 max_text_len = log_buf_len / MAX_LOG_TAKE_PART;
495
496         if (*text_len > max_text_len)
497                 *text_len = max_text_len;
498
499         /* enable the warning message (if there is room) */
500         *trunc_msg_len = strlen(trunc_msg);
501         if (*text_len >= *trunc_msg_len)
502                 *text_len -= *trunc_msg_len;
503         else
504                 *trunc_msg_len = 0;
505 }
506
507 int dmesg_restrict = IS_ENABLED(CONFIG_SECURITY_DMESG_RESTRICT);
508
509 static int syslog_action_restricted(int type)
510 {
511         if (dmesg_restrict)
512                 return 1;
513         /*
514          * Unless restricted, we allow "read all" and "get buffer size"
515          * for everybody.
516          */
517         return type != SYSLOG_ACTION_READ_ALL &&
518                type != SYSLOG_ACTION_SIZE_BUFFER;
519 }
520
521 static int check_syslog_permissions(int type, int source)
522 {
523         /*
524          * If this is from /proc/kmsg and we've already opened it, then we've
525          * already done the capabilities checks at open time.
526          */
527         if (source == SYSLOG_FROM_PROC && type != SYSLOG_ACTION_OPEN)
528                 goto ok;
529
530         if (syslog_action_restricted(type)) {
531                 if (capable(CAP_SYSLOG))
532                         goto ok;
533                 /*
534                  * For historical reasons, accept CAP_SYS_ADMIN too, with
535                  * a warning.
536                  */
537                 if (capable(CAP_SYS_ADMIN)) {
538                         pr_warn_once("%s (%d): Attempt to access syslog with "
539                                      "CAP_SYS_ADMIN but no CAP_SYSLOG "
540                                      "(deprecated).\n",
541                                  current->comm, task_pid_nr(current));
542                         goto ok;
543                 }
544                 return -EPERM;
545         }
546 ok:
547         return security_syslog(type);
548 }
549
550 static void append_char(char **pp, char *e, char c)
551 {
552         if (*pp < e)
553                 *(*pp)++ = c;
554 }
555
556 static ssize_t info_print_ext_header(char *buf, size_t size,
557                                      struct printk_info *info)
558 {
559         u64 ts_usec = info->ts_nsec;
560         char caller[20];
561 #ifdef CONFIG_PRINTK_CALLER
562         u32 id = info->caller_id;
563
564         snprintf(caller, sizeof(caller), ",caller=%c%u",
565                  id & 0x80000000 ? 'C' : 'T', id & ~0x80000000);
566 #else
567         caller[0] = '\0';
568 #endif
569
570         do_div(ts_usec, 1000);
571
572         return scnprintf(buf, size, "%u,%llu,%llu,%c%s;",
573                          (info->facility << 3) | info->level, info->seq,
574                          ts_usec, info->flags & LOG_CONT ? 'c' : '-', caller);
575 }
576
577 static ssize_t msg_add_ext_text(char *buf, size_t size,
578                                 const char *text, size_t text_len,
579                                 unsigned char endc)
580 {
581         char *p = buf, *e = buf + size;
582         size_t i;
583
584         /* escape non-printable characters */
585         for (i = 0; i < text_len; i++) {
586                 unsigned char c = text[i];
587
588                 if (c < ' ' || c >= 127 || c == '\\')
589                         p += scnprintf(p, e - p, "\\x%02x", c);
590                 else
591                         append_char(&p, e, c);
592         }
593         append_char(&p, e, endc);
594
595         return p - buf;
596 }
597
598 static ssize_t msg_add_dict_text(char *buf, size_t size,
599                                  const char *key, const char *val)
600 {
601         size_t val_len = strlen(val);
602         ssize_t len;
603
604         if (!val_len)
605                 return 0;
606
607         len = msg_add_ext_text(buf, size, "", 0, ' ');  /* dict prefix */
608         len += msg_add_ext_text(buf + len, size - len, key, strlen(key), '=');
609         len += msg_add_ext_text(buf + len, size - len, val, val_len, '\n');
610
611         return len;
612 }
613
614 static ssize_t msg_print_ext_body(char *buf, size_t size,
615                                   char *text, size_t text_len,
616                                   struct dev_printk_info *dev_info)
617 {
618         ssize_t len;
619
620         len = msg_add_ext_text(buf, size, text, text_len, '\n');
621
622         if (!dev_info)
623                 goto out;
624
625         len += msg_add_dict_text(buf + len, size - len, "SUBSYSTEM",
626                                  dev_info->subsystem);
627         len += msg_add_dict_text(buf + len, size - len, "DEVICE",
628                                  dev_info->device);
629 out:
630         return len;
631 }
632
633 /* /dev/kmsg - userspace message inject/listen interface */
634 struct devkmsg_user {
635         atomic64_t seq;
636         struct ratelimit_state rs;
637         struct mutex lock;
638         char buf[CONSOLE_EXT_LOG_MAX];
639
640         struct printk_info info;
641         char text_buf[CONSOLE_EXT_LOG_MAX];
642         struct printk_record record;
643 };
644
645 static __printf(3, 4) __cold
646 int devkmsg_emit(int facility, int level, const char *fmt, ...)
647 {
648         va_list args;
649         int r;
650
651         va_start(args, fmt);
652         r = vprintk_emit(facility, level, NULL, fmt, args);
653         va_end(args);
654
655         return r;
656 }
657
658 static ssize_t devkmsg_write(struct kiocb *iocb, struct iov_iter *from)
659 {
660         char *buf, *line;
661         int level = default_message_loglevel;
662         int facility = 1;       /* LOG_USER */
663         struct file *file = iocb->ki_filp;
664         struct devkmsg_user *user = file->private_data;
665         size_t len = iov_iter_count(from);
666         ssize_t ret = len;
667
668         if (!user || len > LOG_LINE_MAX)
669                 return -EINVAL;
670
671         /* Ignore when user logging is disabled. */
672         if (devkmsg_log & DEVKMSG_LOG_MASK_OFF)
673                 return len;
674
675         /* Ratelimit when not explicitly enabled. */
676         if (!(devkmsg_log & DEVKMSG_LOG_MASK_ON)) {
677                 if (!___ratelimit(&user->rs, current->comm))
678                         return ret;
679         }
680
681         buf = kmalloc(len+1, GFP_KERNEL);
682         if (buf == NULL)
683                 return -ENOMEM;
684
685         buf[len] = '\0';
686         if (!copy_from_iter_full(buf, len, from)) {
687                 kfree(buf);
688                 return -EFAULT;
689         }
690
691         /*
692          * Extract and skip the syslog prefix <[0-9]*>. Coming from userspace
693          * the decimal value represents 32bit, the lower 3 bit are the log
694          * level, the rest are the log facility.
695          *
696          * If no prefix or no userspace facility is specified, we
697          * enforce LOG_USER, to be able to reliably distinguish
698          * kernel-generated messages from userspace-injected ones.
699          */
700         line = buf;
701         if (line[0] == '<') {
702                 char *endp = NULL;
703                 unsigned int u;
704
705                 u = simple_strtoul(line + 1, &endp, 10);
706                 if (endp && endp[0] == '>') {
707                         level = LOG_LEVEL(u);
708                         if (LOG_FACILITY(u) != 0)
709                                 facility = LOG_FACILITY(u);
710                         endp++;
711                         line = endp;
712                 }
713         }
714
715         devkmsg_emit(facility, level, "%s", line);
716         kfree(buf);
717         return ret;
718 }
719
720 static ssize_t devkmsg_read(struct file *file, char __user *buf,
721                             size_t count, loff_t *ppos)
722 {
723         struct devkmsg_user *user = file->private_data;
724         struct printk_record *r = &user->record;
725         size_t len;
726         ssize_t ret;
727
728         if (!user)
729                 return -EBADF;
730
731         ret = mutex_lock_interruptible(&user->lock);
732         if (ret)
733                 return ret;
734
735         if (!prb_read_valid(prb, atomic64_read(&user->seq), r)) {
736                 if (file->f_flags & O_NONBLOCK) {
737                         ret = -EAGAIN;
738                         goto out;
739                 }
740
741                 ret = wait_event_interruptible(log_wait,
742                                 prb_read_valid(prb, atomic64_read(&user->seq), r));
743                 if (ret)
744                         goto out;
745         }
746
747         if (r->info->seq != atomic64_read(&user->seq)) {
748                 /* our last seen message is gone, return error and reset */
749                 atomic64_set(&user->seq, r->info->seq);
750                 ret = -EPIPE;
751                 goto out;
752         }
753
754         len = info_print_ext_header(user->buf, sizeof(user->buf), r->info);
755         len += msg_print_ext_body(user->buf + len, sizeof(user->buf) - len,
756                                   &r->text_buf[0], r->info->text_len,
757                                   &r->info->dev_info);
758
759         atomic64_set(&user->seq, r->info->seq + 1);
760
761         if (len > count) {
762                 ret = -EINVAL;
763                 goto out;
764         }
765
766         if (copy_to_user(buf, user->buf, len)) {
767                 ret = -EFAULT;
768                 goto out;
769         }
770         ret = len;
771 out:
772         mutex_unlock(&user->lock);
773         return ret;
774 }
775
776 /*
777  * Be careful when modifying this function!!!
778  *
779  * Only few operations are supported because the device works only with the
780  * entire variable length messages (records). Non-standard values are
781  * returned in the other cases and has been this way for quite some time.
782  * User space applications might depend on this behavior.
783  */
784 static loff_t devkmsg_llseek(struct file *file, loff_t offset, int whence)
785 {
786         struct devkmsg_user *user = file->private_data;
787         loff_t ret = 0;
788
789         if (!user)
790                 return -EBADF;
791         if (offset)
792                 return -ESPIPE;
793
794         switch (whence) {
795         case SEEK_SET:
796                 /* the first record */
797                 atomic64_set(&user->seq, prb_first_valid_seq(prb));
798                 break;
799         case SEEK_DATA:
800                 /*
801                  * The first record after the last SYSLOG_ACTION_CLEAR,
802                  * like issued by 'dmesg -c'. Reading /dev/kmsg itself
803                  * changes no global state, and does not clear anything.
804                  */
805                 atomic64_set(&user->seq, latched_seq_read_nolock(&clear_seq));
806                 break;
807         case SEEK_END:
808                 /* after the last record */
809                 atomic64_set(&user->seq, prb_next_seq(prb));
810                 break;
811         default:
812                 ret = -EINVAL;
813         }
814         return ret;
815 }
816
817 static __poll_t devkmsg_poll(struct file *file, poll_table *wait)
818 {
819         struct devkmsg_user *user = file->private_data;
820         struct printk_info info;
821         __poll_t ret = 0;
822
823         if (!user)
824                 return EPOLLERR|EPOLLNVAL;
825
826         poll_wait(file, &log_wait, wait);
827
828         if (prb_read_valid_info(prb, atomic64_read(&user->seq), &info, NULL)) {
829                 /* return error when data has vanished underneath us */
830                 if (info.seq != atomic64_read(&user->seq))
831                         ret = EPOLLIN|EPOLLRDNORM|EPOLLERR|EPOLLPRI;
832                 else
833                         ret = EPOLLIN|EPOLLRDNORM;
834         }
835
836         return ret;
837 }
838
839 static int devkmsg_open(struct inode *inode, struct file *file)
840 {
841         struct devkmsg_user *user;
842         int err;
843
844         if (devkmsg_log & DEVKMSG_LOG_MASK_OFF)
845                 return -EPERM;
846
847         /* write-only does not need any file context */
848         if ((file->f_flags & O_ACCMODE) != O_WRONLY) {
849                 err = check_syslog_permissions(SYSLOG_ACTION_READ_ALL,
850                                                SYSLOG_FROM_READER);
851                 if (err)
852                         return err;
853         }
854
855         user = kmalloc(sizeof(struct devkmsg_user), GFP_KERNEL);
856         if (!user)
857                 return -ENOMEM;
858
859         ratelimit_default_init(&user->rs);
860         ratelimit_set_flags(&user->rs, RATELIMIT_MSG_ON_RELEASE);
861
862         mutex_init(&user->lock);
863
864         prb_rec_init_rd(&user->record, &user->info,
865                         &user->text_buf[0], sizeof(user->text_buf));
866
867         atomic64_set(&user->seq, prb_first_valid_seq(prb));
868
869         file->private_data = user;
870         return 0;
871 }
872
873 static int devkmsg_release(struct inode *inode, struct file *file)
874 {
875         struct devkmsg_user *user = file->private_data;
876
877         if (!user)
878                 return 0;
879
880         ratelimit_state_exit(&user->rs);
881
882         mutex_destroy(&user->lock);
883         kfree(user);
884         return 0;
885 }
886
887 const struct file_operations kmsg_fops = {
888         .open = devkmsg_open,
889         .read = devkmsg_read,
890         .write_iter = devkmsg_write,
891         .llseek = devkmsg_llseek,
892         .poll = devkmsg_poll,
893         .release = devkmsg_release,
894 };
895
896 #ifdef CONFIG_CRASH_CORE
897 /*
898  * This appends the listed symbols to /proc/vmcore
899  *
900  * /proc/vmcore is used by various utilities, like crash and makedumpfile to
901  * obtain access to symbols that are otherwise very difficult to locate.  These
902  * symbols are specifically used so that utilities can access and extract the
903  * dmesg log from a vmcore file after a crash.
904  */
905 void log_buf_vmcoreinfo_setup(void)
906 {
907         struct dev_printk_info *dev_info = NULL;
908
909         VMCOREINFO_SYMBOL(prb);
910         VMCOREINFO_SYMBOL(printk_rb_static);
911         VMCOREINFO_SYMBOL(clear_seq);
912
913         /*
914          * Export struct size and field offsets. User space tools can
915          * parse it and detect any changes to structure down the line.
916          */
917
918         VMCOREINFO_STRUCT_SIZE(printk_ringbuffer);
919         VMCOREINFO_OFFSET(printk_ringbuffer, desc_ring);
920         VMCOREINFO_OFFSET(printk_ringbuffer, text_data_ring);
921         VMCOREINFO_OFFSET(printk_ringbuffer, fail);
922
923         VMCOREINFO_STRUCT_SIZE(prb_desc_ring);
924         VMCOREINFO_OFFSET(prb_desc_ring, count_bits);
925         VMCOREINFO_OFFSET(prb_desc_ring, descs);
926         VMCOREINFO_OFFSET(prb_desc_ring, infos);
927         VMCOREINFO_OFFSET(prb_desc_ring, head_id);
928         VMCOREINFO_OFFSET(prb_desc_ring, tail_id);
929
930         VMCOREINFO_STRUCT_SIZE(prb_desc);
931         VMCOREINFO_OFFSET(prb_desc, state_var);
932         VMCOREINFO_OFFSET(prb_desc, text_blk_lpos);
933
934         VMCOREINFO_STRUCT_SIZE(prb_data_blk_lpos);
935         VMCOREINFO_OFFSET(prb_data_blk_lpos, begin);
936         VMCOREINFO_OFFSET(prb_data_blk_lpos, next);
937
938         VMCOREINFO_STRUCT_SIZE(printk_info);
939         VMCOREINFO_OFFSET(printk_info, seq);
940         VMCOREINFO_OFFSET(printk_info, ts_nsec);
941         VMCOREINFO_OFFSET(printk_info, text_len);
942         VMCOREINFO_OFFSET(printk_info, caller_id);
943         VMCOREINFO_OFFSET(printk_info, dev_info);
944
945         VMCOREINFO_STRUCT_SIZE(dev_printk_info);
946         VMCOREINFO_OFFSET(dev_printk_info, subsystem);
947         VMCOREINFO_LENGTH(printk_info_subsystem, sizeof(dev_info->subsystem));
948         VMCOREINFO_OFFSET(dev_printk_info, device);
949         VMCOREINFO_LENGTH(printk_info_device, sizeof(dev_info->device));
950
951         VMCOREINFO_STRUCT_SIZE(prb_data_ring);
952         VMCOREINFO_OFFSET(prb_data_ring, size_bits);
953         VMCOREINFO_OFFSET(prb_data_ring, data);
954         VMCOREINFO_OFFSET(prb_data_ring, head_lpos);
955         VMCOREINFO_OFFSET(prb_data_ring, tail_lpos);
956
957         VMCOREINFO_SIZE(atomic_long_t);
958         VMCOREINFO_TYPE_OFFSET(atomic_long_t, counter);
959
960         VMCOREINFO_STRUCT_SIZE(latched_seq);
961         VMCOREINFO_OFFSET(latched_seq, val);
962 }
963 #endif
964
965 /* requested log_buf_len from kernel cmdline */
966 static unsigned long __initdata new_log_buf_len;
967
968 /* we practice scaling the ring buffer by powers of 2 */
969 static void __init log_buf_len_update(u64 size)
970 {
971         if (size > (u64)LOG_BUF_LEN_MAX) {
972                 size = (u64)LOG_BUF_LEN_MAX;
973                 pr_err("log_buf over 2G is not supported.\n");
974         }
975
976         if (size)
977                 size = roundup_pow_of_two(size);
978         if (size > log_buf_len)
979                 new_log_buf_len = (unsigned long)size;
980 }
981
982 /* save requested log_buf_len since it's too early to process it */
983 static int __init log_buf_len_setup(char *str)
984 {
985         u64 size;
986
987         if (!str)
988                 return -EINVAL;
989
990         size = memparse(str, &str);
991
992         log_buf_len_update(size);
993
994         return 0;
995 }
996 early_param("log_buf_len", log_buf_len_setup);
997
998 #ifdef CONFIG_SMP
999 #define __LOG_CPU_MAX_BUF_LEN (1 << CONFIG_LOG_CPU_MAX_BUF_SHIFT)
1000
1001 static void __init log_buf_add_cpu(void)
1002 {
1003         unsigned int cpu_extra;
1004
1005         /*
1006          * archs should set up cpu_possible_bits properly with
1007          * set_cpu_possible() after setup_arch() but just in
1008          * case lets ensure this is valid.
1009          */
1010         if (num_possible_cpus() == 1)
1011                 return;
1012
1013         cpu_extra = (num_possible_cpus() - 1) * __LOG_CPU_MAX_BUF_LEN;
1014
1015         /* by default this will only continue through for large > 64 CPUs */
1016         if (cpu_extra <= __LOG_BUF_LEN / 2)
1017                 return;
1018
1019         pr_info("log_buf_len individual max cpu contribution: %d bytes\n",
1020                 __LOG_CPU_MAX_BUF_LEN);
1021         pr_info("log_buf_len total cpu_extra contributions: %d bytes\n",
1022                 cpu_extra);
1023         pr_info("log_buf_len min size: %d bytes\n", __LOG_BUF_LEN);
1024
1025         log_buf_len_update(cpu_extra + __LOG_BUF_LEN);
1026 }
1027 #else /* !CONFIG_SMP */
1028 static inline void log_buf_add_cpu(void) {}
1029 #endif /* CONFIG_SMP */
1030
1031 static void __init set_percpu_data_ready(void)
1032 {
1033         __printk_percpu_data_ready = true;
1034 }
1035
1036 static unsigned int __init add_to_rb(struct printk_ringbuffer *rb,
1037                                      struct printk_record *r)
1038 {
1039         struct prb_reserved_entry e;
1040         struct printk_record dest_r;
1041
1042         prb_rec_init_wr(&dest_r, r->info->text_len);
1043
1044         if (!prb_reserve(&e, rb, &dest_r))
1045                 return 0;
1046
1047         memcpy(&dest_r.text_buf[0], &r->text_buf[0], r->info->text_len);
1048         dest_r.info->text_len = r->info->text_len;
1049         dest_r.info->facility = r->info->facility;
1050         dest_r.info->level = r->info->level;
1051         dest_r.info->flags = r->info->flags;
1052         dest_r.info->ts_nsec = r->info->ts_nsec;
1053         dest_r.info->caller_id = r->info->caller_id;
1054         memcpy(&dest_r.info->dev_info, &r->info->dev_info, sizeof(dest_r.info->dev_info));
1055
1056         prb_final_commit(&e);
1057
1058         return prb_record_text_space(&e);
1059 }
1060
1061 static char setup_text_buf[LOG_LINE_MAX] __initdata;
1062
1063 void __init setup_log_buf(int early)
1064 {
1065         struct printk_info *new_infos;
1066         unsigned int new_descs_count;
1067         struct prb_desc *new_descs;
1068         struct printk_info info;
1069         struct printk_record r;
1070         unsigned int text_size;
1071         size_t new_descs_size;
1072         size_t new_infos_size;
1073         unsigned long flags;
1074         char *new_log_buf;
1075         unsigned int free;
1076         u64 seq;
1077
1078         /*
1079          * Some archs call setup_log_buf() multiple times - first is very
1080          * early, e.g. from setup_arch(), and second - when percpu_areas
1081          * are initialised.
1082          */
1083         if (!early)
1084                 set_percpu_data_ready();
1085
1086         if (log_buf != __log_buf)
1087                 return;
1088
1089         if (!early && !new_log_buf_len)
1090                 log_buf_add_cpu();
1091
1092         if (!new_log_buf_len)
1093                 return;
1094
1095         new_descs_count = new_log_buf_len >> PRB_AVGBITS;
1096         if (new_descs_count == 0) {
1097                 pr_err("new_log_buf_len: %lu too small\n", new_log_buf_len);
1098                 return;
1099         }
1100
1101         new_log_buf = memblock_alloc(new_log_buf_len, LOG_ALIGN);
1102         if (unlikely(!new_log_buf)) {
1103                 pr_err("log_buf_len: %lu text bytes not available\n",
1104                        new_log_buf_len);
1105                 return;
1106         }
1107
1108         new_descs_size = new_descs_count * sizeof(struct prb_desc);
1109         new_descs = memblock_alloc(new_descs_size, LOG_ALIGN);
1110         if (unlikely(!new_descs)) {
1111                 pr_err("log_buf_len: %zu desc bytes not available\n",
1112                        new_descs_size);
1113                 goto err_free_log_buf;
1114         }
1115
1116         new_infos_size = new_descs_count * sizeof(struct printk_info);
1117         new_infos = memblock_alloc(new_infos_size, LOG_ALIGN);
1118         if (unlikely(!new_infos)) {
1119                 pr_err("log_buf_len: %zu info bytes not available\n",
1120                        new_infos_size);
1121                 goto err_free_descs;
1122         }
1123
1124         prb_rec_init_rd(&r, &info, &setup_text_buf[0], sizeof(setup_text_buf));
1125
1126         prb_init(&printk_rb_dynamic,
1127                  new_log_buf, ilog2(new_log_buf_len),
1128                  new_descs, ilog2(new_descs_count),
1129                  new_infos);
1130
1131         local_irq_save(flags);
1132
1133         log_buf_len = new_log_buf_len;
1134         log_buf = new_log_buf;
1135         new_log_buf_len = 0;
1136
1137         free = __LOG_BUF_LEN;
1138         prb_for_each_record(0, &printk_rb_static, seq, &r) {
1139                 text_size = add_to_rb(&printk_rb_dynamic, &r);
1140                 if (text_size > free)
1141                         free = 0;
1142                 else
1143                         free -= text_size;
1144         }
1145
1146         prb = &printk_rb_dynamic;
1147
1148         local_irq_restore(flags);
1149
1150         /*
1151          * Copy any remaining messages that might have appeared from
1152          * NMI context after copying but before switching to the
1153          * dynamic buffer.
1154          */
1155         prb_for_each_record(seq, &printk_rb_static, seq, &r) {
1156                 text_size = add_to_rb(&printk_rb_dynamic, &r);
1157                 if (text_size > free)
1158                         free = 0;
1159                 else
1160                         free -= text_size;
1161         }
1162
1163         if (seq != prb_next_seq(&printk_rb_static)) {
1164                 pr_err("dropped %llu messages\n",
1165                        prb_next_seq(&printk_rb_static) - seq);
1166         }
1167
1168         pr_info("log_buf_len: %u bytes\n", log_buf_len);
1169         pr_info("early log buf free: %u(%u%%)\n",
1170                 free, (free * 100) / __LOG_BUF_LEN);
1171         return;
1172
1173 err_free_descs:
1174         memblock_free(__pa(new_descs), new_descs_size);
1175 err_free_log_buf:
1176         memblock_free(__pa(new_log_buf), new_log_buf_len);
1177 }
1178
1179 static bool __read_mostly ignore_loglevel;
1180
1181 static int __init ignore_loglevel_setup(char *str)
1182 {
1183         ignore_loglevel = true;
1184         pr_info("debug: ignoring loglevel setting.\n");
1185
1186         return 0;
1187 }
1188
1189 early_param("ignore_loglevel", ignore_loglevel_setup);
1190 module_param(ignore_loglevel, bool, S_IRUGO | S_IWUSR);
1191 MODULE_PARM_DESC(ignore_loglevel,
1192                  "ignore loglevel setting (prints all kernel messages to the console)");
1193
1194 static bool suppress_message_printing(int level)
1195 {
1196         return (level >= console_loglevel && !ignore_loglevel);
1197 }
1198
1199 #ifdef CONFIG_BOOT_PRINTK_DELAY
1200
1201 static int boot_delay; /* msecs delay after each printk during bootup */
1202 static unsigned long long loops_per_msec;       /* based on boot_delay */
1203
1204 static int __init boot_delay_setup(char *str)
1205 {
1206         unsigned long lpj;
1207
1208         lpj = preset_lpj ? preset_lpj : 1000000;        /* some guess */
1209         loops_per_msec = (unsigned long long)lpj / 1000 * HZ;
1210
1211         get_option(&str, &boot_delay);
1212         if (boot_delay > 10 * 1000)
1213                 boot_delay = 0;
1214
1215         pr_debug("boot_delay: %u, preset_lpj: %ld, lpj: %lu, "
1216                 "HZ: %d, loops_per_msec: %llu\n",
1217                 boot_delay, preset_lpj, lpj, HZ, loops_per_msec);
1218         return 0;
1219 }
1220 early_param("boot_delay", boot_delay_setup);
1221
1222 static void boot_delay_msec(int level)
1223 {
1224         unsigned long long k;
1225         unsigned long timeout;
1226
1227         if ((boot_delay == 0 || system_state >= SYSTEM_RUNNING)
1228                 || suppress_message_printing(level)) {
1229                 return;
1230         }
1231
1232         k = (unsigned long long)loops_per_msec * boot_delay;
1233
1234         timeout = jiffies + msecs_to_jiffies(boot_delay);
1235         while (k) {
1236                 k--;
1237                 cpu_relax();
1238                 /*
1239                  * use (volatile) jiffies to prevent
1240                  * compiler reduction; loop termination via jiffies
1241                  * is secondary and may or may not happen.
1242                  */
1243                 if (time_after(jiffies, timeout))
1244                         break;
1245                 touch_nmi_watchdog();
1246         }
1247 }
1248 #else
1249 static inline void boot_delay_msec(int level)
1250 {
1251 }
1252 #endif
1253
1254 static bool printk_time = IS_ENABLED(CONFIG_PRINTK_TIME);
1255 module_param_named(time, printk_time, bool, S_IRUGO | S_IWUSR);
1256
1257 static size_t print_syslog(unsigned int level, char *buf)
1258 {
1259         return sprintf(buf, "<%u>", level);
1260 }
1261
1262 static size_t print_time(u64 ts, char *buf)
1263 {
1264         unsigned long rem_nsec = do_div(ts, 1000000000);
1265
1266         return sprintf(buf, "[%5lu.%06lu]",
1267                        (unsigned long)ts, rem_nsec / 1000);
1268 }
1269
1270 #ifdef CONFIG_PRINTK_CALLER
1271 static size_t print_caller(u32 id, char *buf)
1272 {
1273         char caller[12];
1274
1275         snprintf(caller, sizeof(caller), "%c%u",
1276                  id & 0x80000000 ? 'C' : 'T', id & ~0x80000000);
1277         return sprintf(buf, "[%6s]", caller);
1278 }
1279 #else
1280 #define print_caller(id, buf) 0
1281 #endif
1282
1283 static size_t info_print_prefix(const struct printk_info  *info, bool syslog,
1284                                 bool time, char *buf)
1285 {
1286         size_t len = 0;
1287
1288         if (syslog)
1289                 len = print_syslog((info->facility << 3) | info->level, buf);
1290
1291         if (time)
1292                 len += print_time(info->ts_nsec, buf + len);
1293
1294         len += print_caller(info->caller_id, buf + len);
1295
1296         if (IS_ENABLED(CONFIG_PRINTK_CALLER) || time) {
1297                 buf[len++] = ' ';
1298                 buf[len] = '\0';
1299         }
1300
1301         return len;
1302 }
1303
1304 /*
1305  * Prepare the record for printing. The text is shifted within the given
1306  * buffer to avoid a need for another one. The following operations are
1307  * done:
1308  *
1309  *   - Add prefix for each line.
1310  *   - Drop truncated lines that no longer fit into the buffer.
1311  *   - Add the trailing newline that has been removed in vprintk_store().
1312  *   - Add a string terminator.
1313  *
1314  * Since the produced string is always terminated, the maximum possible
1315  * return value is @r->text_buf_size - 1;
1316  *
1317  * Return: The length of the updated/prepared text, including the added
1318  * prefixes and the newline. The terminator is not counted. The dropped
1319  * line(s) are not counted.
1320  */
1321 static size_t record_print_text(struct printk_record *r, bool syslog,
1322                                 bool time)
1323 {
1324         size_t text_len = r->info->text_len;
1325         size_t buf_size = r->text_buf_size;
1326         char *text = r->text_buf;
1327         char prefix[PREFIX_MAX];
1328         bool truncated = false;
1329         size_t prefix_len;
1330         size_t line_len;
1331         size_t len = 0;
1332         char *next;
1333
1334         /*
1335          * If the message was truncated because the buffer was not large
1336          * enough, treat the available text as if it were the full text.
1337          */
1338         if (text_len > buf_size)
1339                 text_len = buf_size;
1340
1341         prefix_len = info_print_prefix(r->info, syslog, time, prefix);
1342
1343         /*
1344          * @text_len: bytes of unprocessed text
1345          * @line_len: bytes of current line _without_ newline
1346          * @text:     pointer to beginning of current line
1347          * @len:      number of bytes prepared in r->text_buf
1348          */
1349         for (;;) {
1350                 next = memchr(text, '\n', text_len);
1351                 if (next) {
1352                         line_len = next - text;
1353                 } else {
1354                         /* Drop truncated line(s). */
1355                         if (truncated)
1356                                 break;
1357                         line_len = text_len;
1358                 }
1359
1360                 /*
1361                  * Truncate the text if there is not enough space to add the
1362                  * prefix and a trailing newline and a terminator.
1363                  */
1364                 if (len + prefix_len + text_len + 1 + 1 > buf_size) {
1365                         /* Drop even the current line if no space. */
1366                         if (len + prefix_len + line_len + 1 + 1 > buf_size)
1367                                 break;
1368
1369                         text_len = buf_size - len - prefix_len - 1 - 1;
1370                         truncated = true;
1371                 }
1372
1373                 memmove(text + prefix_len, text, text_len);
1374                 memcpy(text, prefix, prefix_len);
1375
1376                 /*
1377                  * Increment the prepared length to include the text and
1378                  * prefix that were just moved+copied. Also increment for the
1379                  * newline at the end of this line. If this is the last line,
1380                  * there is no newline, but it will be added immediately below.
1381                  */
1382                 len += prefix_len + line_len + 1;
1383                 if (text_len == line_len) {
1384                         /*
1385                          * This is the last line. Add the trailing newline
1386                          * removed in vprintk_store().
1387                          */
1388                         text[prefix_len + line_len] = '\n';
1389                         break;
1390                 }
1391
1392                 /*
1393                  * Advance beyond the added prefix and the related line with
1394                  * its newline.
1395                  */
1396                 text += prefix_len + line_len + 1;
1397
1398                 /*
1399                  * The remaining text has only decreased by the line with its
1400                  * newline.
1401                  *
1402                  * Note that @text_len can become zero. It happens when @text
1403                  * ended with a newline (either due to truncation or the
1404                  * original string ending with "\n\n"). The loop is correctly
1405                  * repeated and (if not truncated) an empty line with a prefix
1406                  * will be prepared.
1407                  */
1408                 text_len -= line_len + 1;
1409         }
1410
1411         /*
1412          * If a buffer was provided, it will be terminated. Space for the
1413          * string terminator is guaranteed to be available. The terminator is
1414          * not counted in the return value.
1415          */
1416         if (buf_size > 0)
1417                 r->text_buf[len] = 0;
1418
1419         return len;
1420 }
1421
1422 static size_t get_record_print_text_size(struct printk_info *info,
1423                                          unsigned int line_count,
1424                                          bool syslog, bool time)
1425 {
1426         char prefix[PREFIX_MAX];
1427         size_t prefix_len;
1428
1429         prefix_len = info_print_prefix(info, syslog, time, prefix);
1430
1431         /*
1432          * Each line will be preceded with a prefix. The intermediate
1433          * newlines are already within the text, but a final trailing
1434          * newline will be added.
1435          */
1436         return ((prefix_len * line_count) + info->text_len + 1);
1437 }
1438
1439 /*
1440  * Beginning with @start_seq, find the first record where it and all following
1441  * records up to (but not including) @max_seq fit into @size.
1442  *
1443  * @max_seq is simply an upper bound and does not need to exist. If the caller
1444  * does not require an upper bound, -1 can be used for @max_seq.
1445  */
1446 static u64 find_first_fitting_seq(u64 start_seq, u64 max_seq, size_t size,
1447                                   bool syslog, bool time)
1448 {
1449         struct printk_info info;
1450         unsigned int line_count;
1451         size_t len = 0;
1452         u64 seq;
1453
1454         /* Determine the size of the records up to @max_seq. */
1455         prb_for_each_info(start_seq, prb, seq, &info, &line_count) {
1456                 if (info.seq >= max_seq)
1457                         break;
1458                 len += get_record_print_text_size(&info, line_count, syslog, time);
1459         }
1460
1461         /*
1462          * Adjust the upper bound for the next loop to avoid subtracting
1463          * lengths that were never added.
1464          */
1465         if (seq < max_seq)
1466                 max_seq = seq;
1467
1468         /*
1469          * Move first record forward until length fits into the buffer. Ignore
1470          * newest messages that were not counted in the above cycle. Messages
1471          * might appear and get lost in the meantime. This is a best effort
1472          * that prevents an infinite loop that could occur with a retry.
1473          */
1474         prb_for_each_info(start_seq, prb, seq, &info, &line_count) {
1475                 if (len <= size || info.seq >= max_seq)
1476                         break;
1477                 len -= get_record_print_text_size(&info, line_count, syslog, time);
1478         }
1479
1480         return seq;
1481 }
1482
1483 /* The caller is responsible for making sure @size is greater than 0. */
1484 static int syslog_print(char __user *buf, int size)
1485 {
1486         struct printk_info info;
1487         struct printk_record r;
1488         char *text;
1489         int len = 0;
1490         u64 seq;
1491
1492         text = kmalloc(CONSOLE_LOG_MAX, GFP_KERNEL);
1493         if (!text)
1494                 return -ENOMEM;
1495
1496         prb_rec_init_rd(&r, &info, text, CONSOLE_LOG_MAX);
1497
1498         mutex_lock(&syslog_lock);
1499
1500         /*
1501          * Wait for the @syslog_seq record to be available. @syslog_seq may
1502          * change while waiting.
1503          */
1504         do {
1505                 seq = syslog_seq;
1506
1507                 mutex_unlock(&syslog_lock);
1508                 len = wait_event_interruptible(log_wait, prb_read_valid(prb, seq, NULL));
1509                 mutex_lock(&syslog_lock);
1510
1511                 if (len)
1512                         goto out;
1513         } while (syslog_seq != seq);
1514
1515         /*
1516          * Copy records that fit into the buffer. The above cycle makes sure
1517          * that the first record is always available.
1518          */
1519         do {
1520                 size_t n;
1521                 size_t skip;
1522                 int err;
1523
1524                 if (!prb_read_valid(prb, syslog_seq, &r))
1525                         break;
1526
1527                 if (r.info->seq != syslog_seq) {
1528                         /* message is gone, move to next valid one */
1529                         syslog_seq = r.info->seq;
1530                         syslog_partial = 0;
1531                 }
1532
1533                 /*
1534                  * To keep reading/counting partial line consistent,
1535                  * use printk_time value as of the beginning of a line.
1536                  */
1537                 if (!syslog_partial)
1538                         syslog_time = printk_time;
1539
1540                 skip = syslog_partial;
1541                 n = record_print_text(&r, true, syslog_time);
1542                 if (n - syslog_partial <= size) {
1543                         /* message fits into buffer, move forward */
1544                         syslog_seq = r.info->seq + 1;
1545                         n -= syslog_partial;
1546                         syslog_partial = 0;
1547                 } else if (!len){
1548                         /* partial read(), remember position */
1549                         n = size;
1550                         syslog_partial += n;
1551                 } else
1552                         n = 0;
1553
1554                 if (!n)
1555                         break;
1556
1557                 mutex_unlock(&syslog_lock);
1558                 err = copy_to_user(buf, text + skip, n);
1559                 mutex_lock(&syslog_lock);
1560
1561                 if (err) {
1562                         if (!len)
1563                                 len = -EFAULT;
1564                         break;
1565                 }
1566
1567                 len += n;
1568                 size -= n;
1569                 buf += n;
1570         } while (size);
1571 out:
1572         mutex_unlock(&syslog_lock);
1573         kfree(text);
1574         return len;
1575 }
1576
1577 static int syslog_print_all(char __user *buf, int size, bool clear)
1578 {
1579         struct printk_info info;
1580         struct printk_record r;
1581         char *text;
1582         int len = 0;
1583         u64 seq;
1584         bool time;
1585
1586         text = kmalloc(CONSOLE_LOG_MAX, GFP_KERNEL);
1587         if (!text)
1588                 return -ENOMEM;
1589
1590         time = printk_time;
1591         /*
1592          * Find first record that fits, including all following records,
1593          * into the user-provided buffer for this dump.
1594          */
1595         seq = find_first_fitting_seq(latched_seq_read_nolock(&clear_seq), -1,
1596                                      size, true, time);
1597
1598         prb_rec_init_rd(&r, &info, text, CONSOLE_LOG_MAX);
1599
1600         len = 0;
1601         prb_for_each_record(seq, prb, seq, &r) {
1602                 int textlen;
1603
1604                 textlen = record_print_text(&r, true, time);
1605
1606                 if (len + textlen > size) {
1607                         seq--;
1608                         break;
1609                 }
1610
1611                 if (copy_to_user(buf + len, text, textlen))
1612                         len = -EFAULT;
1613                 else
1614                         len += textlen;
1615
1616                 if (len < 0)
1617                         break;
1618         }
1619
1620         if (clear) {
1621                 mutex_lock(&syslog_lock);
1622                 latched_seq_write(&clear_seq, seq);
1623                 mutex_unlock(&syslog_lock);
1624         }
1625
1626         kfree(text);
1627         return len;
1628 }
1629
1630 static void syslog_clear(void)
1631 {
1632         mutex_lock(&syslog_lock);
1633         latched_seq_write(&clear_seq, prb_next_seq(prb));
1634         mutex_unlock(&syslog_lock);
1635 }
1636
1637 int do_syslog(int type, char __user *buf, int len, int source)
1638 {
1639         struct printk_info info;
1640         bool clear = false;
1641         static int saved_console_loglevel = LOGLEVEL_DEFAULT;
1642         int error;
1643
1644         error = check_syslog_permissions(type, source);
1645         if (error)
1646                 return error;
1647
1648         switch (type) {
1649         case SYSLOG_ACTION_CLOSE:       /* Close log */
1650                 break;
1651         case SYSLOG_ACTION_OPEN:        /* Open log */
1652                 break;
1653         case SYSLOG_ACTION_READ:        /* Read from log */
1654                 if (!buf || len < 0)
1655                         return -EINVAL;
1656                 if (!len)
1657                         return 0;
1658                 if (!access_ok(buf, len))
1659                         return -EFAULT;
1660                 error = syslog_print(buf, len);
1661                 break;
1662         /* Read/clear last kernel messages */
1663         case SYSLOG_ACTION_READ_CLEAR:
1664                 clear = true;
1665                 fallthrough;
1666         /* Read last kernel messages */
1667         case SYSLOG_ACTION_READ_ALL:
1668                 if (!buf || len < 0)
1669                         return -EINVAL;
1670                 if (!len)
1671                         return 0;
1672                 if (!access_ok(buf, len))
1673                         return -EFAULT;
1674                 error = syslog_print_all(buf, len, clear);
1675                 break;
1676         /* Clear ring buffer */
1677         case SYSLOG_ACTION_CLEAR:
1678                 syslog_clear();
1679                 break;
1680         /* Disable logging to console */
1681         case SYSLOG_ACTION_CONSOLE_OFF:
1682                 if (saved_console_loglevel == LOGLEVEL_DEFAULT)
1683                         saved_console_loglevel = console_loglevel;
1684                 console_loglevel = minimum_console_loglevel;
1685                 break;
1686         /* Enable logging to console */
1687         case SYSLOG_ACTION_CONSOLE_ON:
1688                 if (saved_console_loglevel != LOGLEVEL_DEFAULT) {
1689                         console_loglevel = saved_console_loglevel;
1690                         saved_console_loglevel = LOGLEVEL_DEFAULT;
1691                 }
1692                 break;
1693         /* Set level of messages printed to console */
1694         case SYSLOG_ACTION_CONSOLE_LEVEL:
1695                 if (len < 1 || len > 8)
1696                         return -EINVAL;
1697                 if (len < minimum_console_loglevel)
1698                         len = minimum_console_loglevel;
1699                 console_loglevel = len;
1700                 /* Implicitly re-enable logging to console */
1701                 saved_console_loglevel = LOGLEVEL_DEFAULT;
1702                 break;
1703         /* Number of chars in the log buffer */
1704         case SYSLOG_ACTION_SIZE_UNREAD:
1705                 mutex_lock(&syslog_lock);
1706                 if (!prb_read_valid_info(prb, syslog_seq, &info, NULL)) {
1707                         /* No unread messages. */
1708                         mutex_unlock(&syslog_lock);
1709                         return 0;
1710                 }
1711                 if (info.seq != syslog_seq) {
1712                         /* messages are gone, move to first one */
1713                         syslog_seq = info.seq;
1714                         syslog_partial = 0;
1715                 }
1716                 if (source == SYSLOG_FROM_PROC) {
1717                         /*
1718                          * Short-cut for poll(/"proc/kmsg") which simply checks
1719                          * for pending data, not the size; return the count of
1720                          * records, not the length.
1721                          */
1722                         error = prb_next_seq(prb) - syslog_seq;
1723                 } else {
1724                         bool time = syslog_partial ? syslog_time : printk_time;
1725                         unsigned int line_count;
1726                         u64 seq;
1727
1728                         prb_for_each_info(syslog_seq, prb, seq, &info,
1729                                           &line_count) {
1730                                 error += get_record_print_text_size(&info, line_count,
1731                                                                     true, time);
1732                                 time = printk_time;
1733                         }
1734                         error -= syslog_partial;
1735                 }
1736                 mutex_unlock(&syslog_lock);
1737                 break;
1738         /* Size of the log buffer */
1739         case SYSLOG_ACTION_SIZE_BUFFER:
1740                 error = log_buf_len;
1741                 break;
1742         default:
1743                 error = -EINVAL;
1744                 break;
1745         }
1746
1747         return error;
1748 }
1749
1750 SYSCALL_DEFINE3(syslog, int, type, char __user *, buf, int, len)
1751 {
1752         return do_syslog(type, buf, len, SYSLOG_FROM_READER);
1753 }
1754
1755 /*
1756  * Special console_lock variants that help to reduce the risk of soft-lockups.
1757  * They allow to pass console_lock to another printk() call using a busy wait.
1758  */
1759
1760 #ifdef CONFIG_LOCKDEP
1761 static struct lockdep_map console_owner_dep_map = {
1762         .name = "console_owner"
1763 };
1764 #endif
1765
1766 static DEFINE_RAW_SPINLOCK(console_owner_lock);
1767 static struct task_struct *console_owner;
1768 static bool console_waiter;
1769
1770 /**
1771  * console_lock_spinning_enable - mark beginning of code where another
1772  *      thread might safely busy wait
1773  *
1774  * This basically converts console_lock into a spinlock. This marks
1775  * the section where the console_lock owner can not sleep, because
1776  * there may be a waiter spinning (like a spinlock). Also it must be
1777  * ready to hand over the lock at the end of the section.
1778  */
1779 static void console_lock_spinning_enable(void)
1780 {
1781         raw_spin_lock(&console_owner_lock);
1782         console_owner = current;
1783         raw_spin_unlock(&console_owner_lock);
1784
1785         /* The waiter may spin on us after setting console_owner */
1786         spin_acquire(&console_owner_dep_map, 0, 0, _THIS_IP_);
1787 }
1788
1789 /**
1790  * console_lock_spinning_disable_and_check - mark end of code where another
1791  *      thread was able to busy wait and check if there is a waiter
1792  *
1793  * This is called at the end of the section where spinning is allowed.
1794  * It has two functions. First, it is a signal that it is no longer
1795  * safe to start busy waiting for the lock. Second, it checks if
1796  * there is a busy waiter and passes the lock rights to her.
1797  *
1798  * Important: Callers lose the lock if there was a busy waiter.
1799  *      They must not touch items synchronized by console_lock
1800  *      in this case.
1801  *
1802  * Return: 1 if the lock rights were passed, 0 otherwise.
1803  */
1804 static int console_lock_spinning_disable_and_check(void)
1805 {
1806         int waiter;
1807
1808         raw_spin_lock(&console_owner_lock);
1809         waiter = READ_ONCE(console_waiter);
1810         console_owner = NULL;
1811         raw_spin_unlock(&console_owner_lock);
1812
1813         if (!waiter) {
1814                 spin_release(&console_owner_dep_map, _THIS_IP_);
1815                 return 0;
1816         }
1817
1818         /* The waiter is now free to continue */
1819         WRITE_ONCE(console_waiter, false);
1820
1821         spin_release(&console_owner_dep_map, _THIS_IP_);
1822
1823         /*
1824          * Hand off console_lock to waiter. The waiter will perform
1825          * the up(). After this, the waiter is the console_lock owner.
1826          */
1827         mutex_release(&console_lock_dep_map, _THIS_IP_);
1828         return 1;
1829 }
1830
1831 /**
1832  * console_trylock_spinning - try to get console_lock by busy waiting
1833  *
1834  * This allows to busy wait for the console_lock when the current
1835  * owner is running in specially marked sections. It means that
1836  * the current owner is running and cannot reschedule until it
1837  * is ready to lose the lock.
1838  *
1839  * Return: 1 if we got the lock, 0 othrewise
1840  */
1841 static int console_trylock_spinning(void)
1842 {
1843         struct task_struct *owner = NULL;
1844         bool waiter;
1845         bool spin = false;
1846         unsigned long flags;
1847
1848         if (console_trylock())
1849                 return 1;
1850
1851         printk_safe_enter_irqsave(flags);
1852
1853         raw_spin_lock(&console_owner_lock);
1854         owner = READ_ONCE(console_owner);
1855         waiter = READ_ONCE(console_waiter);
1856         if (!waiter && owner && owner != current) {
1857                 WRITE_ONCE(console_waiter, true);
1858                 spin = true;
1859         }
1860         raw_spin_unlock(&console_owner_lock);
1861
1862         /*
1863          * If there is an active printk() writing to the
1864          * consoles, instead of having it write our data too,
1865          * see if we can offload that load from the active
1866          * printer, and do some printing ourselves.
1867          * Go into a spin only if there isn't already a waiter
1868          * spinning, and there is an active printer, and
1869          * that active printer isn't us (recursive printk?).
1870          */
1871         if (!spin) {
1872                 printk_safe_exit_irqrestore(flags);
1873                 return 0;
1874         }
1875
1876         /* We spin waiting for the owner to release us */
1877         spin_acquire(&console_owner_dep_map, 0, 0, _THIS_IP_);
1878         /* Owner will clear console_waiter on hand off */
1879         while (READ_ONCE(console_waiter))
1880                 cpu_relax();
1881         spin_release(&console_owner_dep_map, _THIS_IP_);
1882
1883         printk_safe_exit_irqrestore(flags);
1884         /*
1885          * The owner passed the console lock to us.
1886          * Since we did not spin on console lock, annotate
1887          * this as a trylock. Otherwise lockdep will
1888          * complain.
1889          */
1890         mutex_acquire(&console_lock_dep_map, 0, 1, _THIS_IP_);
1891
1892         return 1;
1893 }
1894
1895 /*
1896  * Call the console drivers, asking them to write out
1897  * log_buf[start] to log_buf[end - 1].
1898  * The console_lock must be held.
1899  */
1900 static void call_console_drivers(const char *ext_text, size_t ext_len,
1901                                  const char *text, size_t len)
1902 {
1903         static char dropped_text[64];
1904         size_t dropped_len = 0;
1905         struct console *con;
1906
1907         trace_console_rcuidle(text, len);
1908
1909         if (!console_drivers)
1910                 return;
1911
1912         if (console_dropped) {
1913                 dropped_len = snprintf(dropped_text, sizeof(dropped_text),
1914                                        "** %lu printk messages dropped **\n",
1915                                        console_dropped);
1916                 console_dropped = 0;
1917         }
1918
1919         for_each_console(con) {
1920                 if (exclusive_console && con != exclusive_console)
1921                         continue;
1922                 if (!(con->flags & CON_ENABLED))
1923                         continue;
1924                 if (!con->write)
1925                         continue;
1926                 if (!cpu_online(smp_processor_id()) &&
1927                     !(con->flags & CON_ANYTIME))
1928                         continue;
1929                 if (con->flags & CON_EXTENDED)
1930                         con->write(con, ext_text, ext_len);
1931                 else {
1932                         if (dropped_len)
1933                                 con->write(con, dropped_text, dropped_len);
1934                         con->write(con, text, len);
1935                 }
1936         }
1937 }
1938
1939 /*
1940  * Recursion is tracked separately on each CPU. If NMIs are supported, an
1941  * additional NMI context per CPU is also separately tracked. Until per-CPU
1942  * is available, a separate "early tracking" is performed.
1943  */
1944 static DEFINE_PER_CPU(u8, printk_count);
1945 static u8 printk_count_early;
1946 #ifdef CONFIG_HAVE_NMI
1947 static DEFINE_PER_CPU(u8, printk_count_nmi);
1948 static u8 printk_count_nmi_early;
1949 #endif
1950
1951 /*
1952  * Recursion is limited to keep the output sane. printk() should not require
1953  * more than 1 level of recursion (allowing, for example, printk() to trigger
1954  * a WARN), but a higher value is used in case some printk-internal errors
1955  * exist, such as the ringbuffer validation checks failing.
1956  */
1957 #define PRINTK_MAX_RECURSION 3
1958
1959 /*
1960  * Return a pointer to the dedicated counter for the CPU+context of the
1961  * caller.
1962  */
1963 static u8 *__printk_recursion_counter(void)
1964 {
1965 #ifdef CONFIG_HAVE_NMI
1966         if (in_nmi()) {
1967                 if (printk_percpu_data_ready())
1968                         return this_cpu_ptr(&printk_count_nmi);
1969                 return &printk_count_nmi_early;
1970         }
1971 #endif
1972         if (printk_percpu_data_ready())
1973                 return this_cpu_ptr(&printk_count);
1974         return &printk_count_early;
1975 }
1976
1977 /*
1978  * Enter recursion tracking. Interrupts are disabled to simplify tracking.
1979  * The caller must check the boolean return value to see if the recursion is
1980  * allowed. On failure, interrupts are not disabled.
1981  *
1982  * @recursion_ptr must be a variable of type (u8 *) and is the same variable
1983  * that is passed to printk_exit_irqrestore().
1984  */
1985 #define printk_enter_irqsave(recursion_ptr, flags)      \
1986 ({                                                      \
1987         bool success = true;                            \
1988                                                         \
1989         typecheck(u8 *, recursion_ptr);                 \
1990         local_irq_save(flags);                          \
1991         (recursion_ptr) = __printk_recursion_counter(); \
1992         if (*(recursion_ptr) > PRINTK_MAX_RECURSION) {  \
1993                 local_irq_restore(flags);               \
1994                 success = false;                        \
1995         } else {                                        \
1996                 (*(recursion_ptr))++;                   \
1997         }                                               \
1998         success;                                        \
1999 })
2000
2001 /* Exit recursion tracking, restoring interrupts. */
2002 #define printk_exit_irqrestore(recursion_ptr, flags)    \
2003         do {                                            \
2004                 typecheck(u8 *, recursion_ptr);         \
2005                 (*(recursion_ptr))--;                   \
2006                 local_irq_restore(flags);               \
2007         } while (0)
2008
2009 int printk_delay_msec __read_mostly;
2010
2011 static inline void printk_delay(void)
2012 {
2013         if (unlikely(printk_delay_msec)) {
2014                 int m = printk_delay_msec;
2015
2016                 while (m--) {
2017                         mdelay(1);
2018                         touch_nmi_watchdog();
2019                 }
2020         }
2021 }
2022
2023 static inline u32 printk_caller_id(void)
2024 {
2025         return in_task() ? task_pid_nr(current) :
2026                 0x80000000 + raw_smp_processor_id();
2027 }
2028
2029 /**
2030  * parse_prefix - Parse level and control flags.
2031  *
2032  * @text:     The terminated text message.
2033  * @level:    A pointer to the current level value, will be updated.
2034  * @lflags:   A pointer to the current log flags, will be updated.
2035  *
2036  * @level may be NULL if the caller is not interested in the parsed value.
2037  * Otherwise the variable pointed to by @level must be set to
2038  * LOGLEVEL_DEFAULT in order to be updated with the parsed value.
2039  *
2040  * @lflags may be NULL if the caller is not interested in the parsed value.
2041  * Otherwise the variable pointed to by @lflags will be OR'd with the parsed
2042  * value.
2043  *
2044  * Return: The length of the parsed level and control flags.
2045  */
2046 static u16 parse_prefix(char *text, int *level, enum log_flags *lflags)
2047 {
2048         u16 prefix_len = 0;
2049         int kern_level;
2050
2051         while (*text) {
2052                 kern_level = printk_get_level(text);
2053                 if (!kern_level)
2054                         break;
2055
2056                 switch (kern_level) {
2057                 case '0' ... '7':
2058                         if (level && *level == LOGLEVEL_DEFAULT)
2059                                 *level = kern_level - '0';
2060                         break;
2061                 case 'c':       /* KERN_CONT */
2062                         if (lflags)
2063                                 *lflags |= LOG_CONT;
2064                 }
2065
2066                 prefix_len += 2;
2067                 text += 2;
2068         }
2069
2070         return prefix_len;
2071 }
2072
2073 static u16 printk_sprint(char *text, u16 size, int facility, enum log_flags *lflags,
2074                          const char *fmt, va_list args)
2075 {
2076         u16 text_len;
2077
2078         text_len = vscnprintf(text, size, fmt, args);
2079
2080         /* Mark and strip a trailing newline. */
2081         if (text_len && text[text_len - 1] == '\n') {
2082                 text_len--;
2083                 *lflags |= LOG_NEWLINE;
2084         }
2085
2086         /* Strip log level and control flags. */
2087         if (facility == 0) {
2088                 u16 prefix_len;
2089
2090                 prefix_len = parse_prefix(text, NULL, NULL);
2091                 if (prefix_len) {
2092                         text_len -= prefix_len;
2093                         memmove(text, text + prefix_len, text_len);
2094                 }
2095         }
2096
2097         return text_len;
2098 }
2099
2100 __printf(4, 0)
2101 int vprintk_store(int facility, int level,
2102                   const struct dev_printk_info *dev_info,
2103                   const char *fmt, va_list args)
2104 {
2105         const u32 caller_id = printk_caller_id();
2106         struct prb_reserved_entry e;
2107         enum log_flags lflags = 0;
2108         struct printk_record r;
2109         unsigned long irqflags;
2110         u16 trunc_msg_len = 0;
2111         char prefix_buf[8];
2112         u8 *recursion_ptr;
2113         u16 reserve_size;
2114         va_list args2;
2115         u16 text_len;
2116         int ret = 0;
2117         u64 ts_nsec;
2118
2119         /*
2120          * Since the duration of printk() can vary depending on the message
2121          * and state of the ringbuffer, grab the timestamp now so that it is
2122          * close to the call of printk(). This provides a more deterministic
2123          * timestamp with respect to the caller.
2124          */
2125         ts_nsec = local_clock();
2126
2127         if (!printk_enter_irqsave(recursion_ptr, irqflags))
2128                 return 0;
2129
2130         /*
2131          * The sprintf needs to come first since the syslog prefix might be
2132          * passed in as a parameter. An extra byte must be reserved so that
2133          * later the vscnprintf() into the reserved buffer has room for the
2134          * terminating '\0', which is not counted by vsnprintf().
2135          */
2136         va_copy(args2, args);
2137         reserve_size = vsnprintf(&prefix_buf[0], sizeof(prefix_buf), fmt, args2) + 1;
2138         va_end(args2);
2139
2140         if (reserve_size > LOG_LINE_MAX)
2141                 reserve_size = LOG_LINE_MAX;
2142
2143         /* Extract log level or control flags. */
2144         if (facility == 0)
2145                 parse_prefix(&prefix_buf[0], &level, &lflags);
2146
2147         if (level == LOGLEVEL_DEFAULT)
2148                 level = default_message_loglevel;
2149
2150         if (dev_info)
2151                 lflags |= LOG_NEWLINE;
2152
2153         if (lflags & LOG_CONT) {
2154                 prb_rec_init_wr(&r, reserve_size);
2155                 if (prb_reserve_in_last(&e, prb, &r, caller_id, LOG_LINE_MAX)) {
2156                         text_len = printk_sprint(&r.text_buf[r.info->text_len], reserve_size,
2157                                                  facility, &lflags, fmt, args);
2158                         r.info->text_len += text_len;
2159
2160                         if (lflags & LOG_NEWLINE) {
2161                                 r.info->flags |= LOG_NEWLINE;
2162                                 prb_final_commit(&e);
2163                         } else {
2164                                 prb_commit(&e);
2165                         }
2166
2167                         ret = text_len;
2168                         goto out;
2169                 }
2170         }
2171
2172         /*
2173          * Explicitly initialize the record before every prb_reserve() call.
2174          * prb_reserve_in_last() and prb_reserve() purposely invalidate the
2175          * structure when they fail.
2176          */
2177         prb_rec_init_wr(&r, reserve_size);
2178         if (!prb_reserve(&e, prb, &r)) {
2179                 /* truncate the message if it is too long for empty buffer */
2180                 truncate_msg(&reserve_size, &trunc_msg_len);
2181
2182                 prb_rec_init_wr(&r, reserve_size + trunc_msg_len);
2183                 if (!prb_reserve(&e, prb, &r))
2184                         goto out;
2185         }
2186
2187         /* fill message */
2188         text_len = printk_sprint(&r.text_buf[0], reserve_size, facility, &lflags, fmt, args);
2189         if (trunc_msg_len)
2190                 memcpy(&r.text_buf[text_len], trunc_msg, trunc_msg_len);
2191         r.info->text_len = text_len + trunc_msg_len;
2192         r.info->facility = facility;
2193         r.info->level = level & 7;
2194         r.info->flags = lflags & 0x1f;
2195         r.info->ts_nsec = ts_nsec;
2196         r.info->caller_id = caller_id;
2197         if (dev_info)
2198                 memcpy(&r.info->dev_info, dev_info, sizeof(r.info->dev_info));
2199
2200         /* A message without a trailing newline can be continued. */
2201         if (!(lflags & LOG_NEWLINE))
2202                 prb_commit(&e);
2203         else
2204                 prb_final_commit(&e);
2205
2206         ret = text_len + trunc_msg_len;
2207 out:
2208         printk_exit_irqrestore(recursion_ptr, irqflags);
2209         return ret;
2210 }
2211
2212 asmlinkage int vprintk_emit(int facility, int level,
2213                             const struct dev_printk_info *dev_info,
2214                             const char *fmt, va_list args)
2215 {
2216         int printed_len;
2217         bool in_sched = false;
2218
2219         /* Suppress unimportant messages after panic happens */
2220         if (unlikely(suppress_printk))
2221                 return 0;
2222
2223         if (level == LOGLEVEL_SCHED) {
2224                 level = LOGLEVEL_DEFAULT;
2225                 in_sched = true;
2226         }
2227
2228         boot_delay_msec(level);
2229         printk_delay();
2230
2231         printed_len = vprintk_store(facility, level, dev_info, fmt, args);
2232
2233         /* If called from the scheduler, we can not call up(). */
2234         if (!in_sched) {
2235                 /*
2236                  * Disable preemption to avoid being preempted while holding
2237                  * console_sem which would prevent anyone from printing to
2238                  * console
2239                  */
2240                 preempt_disable();
2241                 /*
2242                  * Try to acquire and then immediately release the console
2243                  * semaphore.  The release will print out buffers and wake up
2244                  * /dev/kmsg and syslog() users.
2245                  */
2246                 if (console_trylock_spinning())
2247                         console_unlock();
2248                 preempt_enable();
2249         }
2250
2251         wake_up_klogd();
2252         return printed_len;
2253 }
2254 EXPORT_SYMBOL(vprintk_emit);
2255
2256 int vprintk_default(const char *fmt, va_list args)
2257 {
2258         return vprintk_emit(0, LOGLEVEL_DEFAULT, NULL, fmt, args);
2259 }
2260 EXPORT_SYMBOL_GPL(vprintk_default);
2261
2262 /**
2263  * printk - print a kernel message
2264  * @fmt: format string
2265  *
2266  * This is printk(). It can be called from any context. We want it to work.
2267  *
2268  * We try to grab the console_lock. If we succeed, it's easy - we log the
2269  * output and call the console drivers.  If we fail to get the semaphore, we
2270  * place the output into the log buffer and return. The current holder of
2271  * the console_sem will notice the new output in console_unlock(); and will
2272  * send it to the consoles before releasing the lock.
2273  *
2274  * One effect of this deferred printing is that code which calls printk() and
2275  * then changes console_loglevel may break. This is because console_loglevel
2276  * is inspected when the actual printing occurs.
2277  *
2278  * See also:
2279  * printf(3)
2280  *
2281  * See the vsnprintf() documentation for format string extensions over C99.
2282  */
2283 asmlinkage __visible int printk(const char *fmt, ...)
2284 {
2285         va_list args;
2286         int r;
2287
2288         va_start(args, fmt);
2289         r = vprintk(fmt, args);
2290         va_end(args);
2291
2292         return r;
2293 }
2294 EXPORT_SYMBOL(printk);
2295
2296 #else /* CONFIG_PRINTK */
2297
2298 #define CONSOLE_LOG_MAX         0
2299 #define printk_time             false
2300
2301 #define prb_read_valid(rb, seq, r)      false
2302 #define prb_first_valid_seq(rb)         0
2303
2304 static u64 syslog_seq;
2305 static u64 console_seq;
2306 static u64 exclusive_console_stop_seq;
2307 static unsigned long console_dropped;
2308
2309 static size_t record_print_text(const struct printk_record *r,
2310                                 bool syslog, bool time)
2311 {
2312         return 0;
2313 }
2314 static ssize_t info_print_ext_header(char *buf, size_t size,
2315                                      struct printk_info *info)
2316 {
2317         return 0;
2318 }
2319 static ssize_t msg_print_ext_body(char *buf, size_t size,
2320                                   char *text, size_t text_len,
2321                                   struct dev_printk_info *dev_info) { return 0; }
2322 static void console_lock_spinning_enable(void) { }
2323 static int console_lock_spinning_disable_and_check(void) { return 0; }
2324 static void call_console_drivers(const char *ext_text, size_t ext_len,
2325                                  const char *text, size_t len) {}
2326 static bool suppress_message_printing(int level) { return false; }
2327
2328 #endif /* CONFIG_PRINTK */
2329
2330 #ifdef CONFIG_EARLY_PRINTK
2331 struct console *early_console;
2332
2333 asmlinkage __visible void early_printk(const char *fmt, ...)
2334 {
2335         va_list ap;
2336         char buf[512];
2337         int n;
2338
2339         if (!early_console)
2340                 return;
2341
2342         va_start(ap, fmt);
2343         n = vscnprintf(buf, sizeof(buf), fmt, ap);
2344         va_end(ap);
2345
2346         early_console->write(early_console, buf, n);
2347 }
2348 #endif
2349
2350 static int __add_preferred_console(char *name, int idx, char *options,
2351                                    char *brl_options, bool user_specified)
2352 {
2353         struct console_cmdline *c;
2354         int i;
2355
2356         /*
2357          *      See if this tty is not yet registered, and
2358          *      if we have a slot free.
2359          */
2360         for (i = 0, c = console_cmdline;
2361              i < MAX_CMDLINECONSOLES && c->name[0];
2362              i++, c++) {
2363                 if (strcmp(c->name, name) == 0 && c->index == idx) {
2364                         if (!brl_options)
2365                                 preferred_console = i;
2366                         if (user_specified)
2367                                 c->user_specified = true;
2368                         return 0;
2369                 }
2370         }
2371         if (i == MAX_CMDLINECONSOLES)
2372                 return -E2BIG;
2373         if (!brl_options)
2374                 preferred_console = i;
2375         strlcpy(c->name, name, sizeof(c->name));
2376         c->options = options;
2377         c->user_specified = user_specified;
2378         braille_set_options(c, brl_options);
2379
2380         c->index = idx;
2381         return 0;
2382 }
2383
2384 static int __init console_msg_format_setup(char *str)
2385 {
2386         if (!strcmp(str, "syslog"))
2387                 console_msg_format = MSG_FORMAT_SYSLOG;
2388         if (!strcmp(str, "default"))
2389                 console_msg_format = MSG_FORMAT_DEFAULT;
2390         return 1;
2391 }
2392 __setup("console_msg_format=", console_msg_format_setup);
2393
2394 /*
2395  * Set up a console.  Called via do_early_param() in init/main.c
2396  * for each "console=" parameter in the boot command line.
2397  */
2398 static int __init console_setup(char *str)
2399 {
2400         char buf[sizeof(console_cmdline[0].name) + 4]; /* 4 for "ttyS" */
2401         char *s, *options, *brl_options = NULL;
2402         int idx;
2403
2404         /*
2405          * console="" or console=null have been suggested as a way to
2406          * disable console output. Use ttynull that has been created
2407          * for exactly this purpose.
2408          */
2409         if (str[0] == 0 || strcmp(str, "null") == 0) {
2410                 __add_preferred_console("ttynull", 0, NULL, NULL, true);
2411                 return 1;
2412         }
2413
2414         if (_braille_console_setup(&str, &brl_options))
2415                 return 1;
2416
2417         /*
2418          * Decode str into name, index, options.
2419          */
2420         if (str[0] >= '0' && str[0] <= '9') {
2421                 strcpy(buf, "ttyS");
2422                 strncpy(buf + 4, str, sizeof(buf) - 5);
2423         } else {
2424                 strncpy(buf, str, sizeof(buf) - 1);
2425         }
2426         buf[sizeof(buf) - 1] = 0;
2427         options = strchr(str, ',');
2428         if (options)
2429                 *(options++) = 0;
2430 #ifdef __sparc__
2431         if (!strcmp(str, "ttya"))
2432                 strcpy(buf, "ttyS0");
2433         if (!strcmp(str, "ttyb"))
2434                 strcpy(buf, "ttyS1");
2435 #endif
2436         for (s = buf; *s; s++)
2437                 if (isdigit(*s) || *s == ',')
2438                         break;
2439         idx = simple_strtoul(s, NULL, 10);
2440         *s = 0;
2441
2442         __add_preferred_console(buf, idx, options, brl_options, true);
2443         console_set_on_cmdline = 1;
2444         return 1;
2445 }
2446 __setup("console=", console_setup);
2447
2448 /**
2449  * add_preferred_console - add a device to the list of preferred consoles.
2450  * @name: device name
2451  * @idx: device index
2452  * @options: options for this console
2453  *
2454  * The last preferred console added will be used for kernel messages
2455  * and stdin/out/err for init.  Normally this is used by console_setup
2456  * above to handle user-supplied console arguments; however it can also
2457  * be used by arch-specific code either to override the user or more
2458  * commonly to provide a default console (ie from PROM variables) when
2459  * the user has not supplied one.
2460  */
2461 int add_preferred_console(char *name, int idx, char *options)
2462 {
2463         return __add_preferred_console(name, idx, options, NULL, false);
2464 }
2465
2466 bool console_suspend_enabled = true;
2467 EXPORT_SYMBOL(console_suspend_enabled);
2468
2469 static int __init console_suspend_disable(char *str)
2470 {
2471         console_suspend_enabled = false;
2472         return 1;
2473 }
2474 __setup("no_console_suspend", console_suspend_disable);
2475 module_param_named(console_suspend, console_suspend_enabled,
2476                 bool, S_IRUGO | S_IWUSR);
2477 MODULE_PARM_DESC(console_suspend, "suspend console during suspend"
2478         " and hibernate operations");
2479
2480 /**
2481  * suspend_console - suspend the console subsystem
2482  *
2483  * This disables printk() while we go into suspend states
2484  */
2485 void suspend_console(void)
2486 {
2487         if (!console_suspend_enabled)
2488                 return;
2489         pr_info("Suspending console(s) (use no_console_suspend to debug)\n");
2490         console_lock();
2491         console_suspended = 1;
2492         up_console_sem();
2493 }
2494
2495 void resume_console(void)
2496 {
2497         if (!console_suspend_enabled)
2498                 return;
2499         down_console_sem();
2500         console_suspended = 0;
2501         console_unlock();
2502 }
2503
2504 /**
2505  * console_cpu_notify - print deferred console messages after CPU hotplug
2506  * @cpu: unused
2507  *
2508  * If printk() is called from a CPU that is not online yet, the messages
2509  * will be printed on the console only if there are CON_ANYTIME consoles.
2510  * This function is called when a new CPU comes online (or fails to come
2511  * up) or goes offline.
2512  */
2513 static int console_cpu_notify(unsigned int cpu)
2514 {
2515         if (!cpuhp_tasks_frozen) {
2516                 /* If trylock fails, someone else is doing the printing */
2517                 if (console_trylock())
2518                         console_unlock();
2519         }
2520         return 0;
2521 }
2522
2523 /**
2524  * console_lock - lock the console system for exclusive use.
2525  *
2526  * Acquires a lock which guarantees that the caller has
2527  * exclusive access to the console system and the console_drivers list.
2528  *
2529  * Can sleep, returns nothing.
2530  */
2531 void console_lock(void)
2532 {
2533         might_sleep();
2534
2535         down_console_sem();
2536         if (console_suspended)
2537                 return;
2538         console_locked = 1;
2539         console_may_schedule = 1;
2540 }
2541 EXPORT_SYMBOL(console_lock);
2542
2543 /**
2544  * console_trylock - try to lock the console system for exclusive use.
2545  *
2546  * Try to acquire a lock which guarantees that the caller has exclusive
2547  * access to the console system and the console_drivers list.
2548  *
2549  * returns 1 on success, and 0 on failure to acquire the lock.
2550  */
2551 int console_trylock(void)
2552 {
2553         if (down_trylock_console_sem())
2554                 return 0;
2555         if (console_suspended) {
2556                 up_console_sem();
2557                 return 0;
2558         }
2559         console_locked = 1;
2560         console_may_schedule = 0;
2561         return 1;
2562 }
2563 EXPORT_SYMBOL(console_trylock);
2564
2565 int is_console_locked(void)
2566 {
2567         return console_locked;
2568 }
2569 EXPORT_SYMBOL(is_console_locked);
2570
2571 /*
2572  * Check if we have any console that is capable of printing while cpu is
2573  * booting or shutting down. Requires console_sem.
2574  */
2575 static int have_callable_console(void)
2576 {
2577         struct console *con;
2578
2579         for_each_console(con)
2580                 if ((con->flags & CON_ENABLED) &&
2581                                 (con->flags & CON_ANYTIME))
2582                         return 1;
2583
2584         return 0;
2585 }
2586
2587 /*
2588  * Can we actually use the console at this time on this cpu?
2589  *
2590  * Console drivers may assume that per-cpu resources have been allocated. So
2591  * unless they're explicitly marked as being able to cope (CON_ANYTIME) don't
2592  * call them until this CPU is officially up.
2593  */
2594 static inline int can_use_console(void)
2595 {
2596         return cpu_online(raw_smp_processor_id()) || have_callable_console();
2597 }
2598
2599 /**
2600  * console_unlock - unlock the console system
2601  *
2602  * Releases the console_lock which the caller holds on the console system
2603  * and the console driver list.
2604  *
2605  * While the console_lock was held, console output may have been buffered
2606  * by printk().  If this is the case, console_unlock(); emits
2607  * the output prior to releasing the lock.
2608  *
2609  * If there is output waiting, we wake /dev/kmsg and syslog() users.
2610  *
2611  * console_unlock(); may be called from any context.
2612  */
2613 void console_unlock(void)
2614 {
2615         static char ext_text[CONSOLE_EXT_LOG_MAX];
2616         static char text[CONSOLE_LOG_MAX];
2617         unsigned long flags;
2618         bool do_cond_resched, retry;
2619         struct printk_info info;
2620         struct printk_record r;
2621
2622         if (console_suspended) {
2623                 up_console_sem();
2624                 return;
2625         }
2626
2627         prb_rec_init_rd(&r, &info, text, sizeof(text));
2628
2629         /*
2630          * Console drivers are called with interrupts disabled, so
2631          * @console_may_schedule should be cleared before; however, we may
2632          * end up dumping a lot of lines, for example, if called from
2633          * console registration path, and should invoke cond_resched()
2634          * between lines if allowable.  Not doing so can cause a very long
2635          * scheduling stall on a slow console leading to RCU stall and
2636          * softlockup warnings which exacerbate the issue with more
2637          * messages practically incapacitating the system.
2638          *
2639          * console_trylock() is not able to detect the preemptive
2640          * context reliably. Therefore the value must be stored before
2641          * and cleared after the "again" goto label.
2642          */
2643         do_cond_resched = console_may_schedule;
2644 again:
2645         console_may_schedule = 0;
2646
2647         /*
2648          * We released the console_sem lock, so we need to recheck if
2649          * cpu is online and (if not) is there at least one CON_ANYTIME
2650          * console.
2651          */
2652         if (!can_use_console()) {
2653                 console_locked = 0;
2654                 up_console_sem();
2655                 return;
2656         }
2657
2658         for (;;) {
2659                 size_t ext_len = 0;
2660                 int handover;
2661                 size_t len;
2662
2663 skip:
2664                 if (!prb_read_valid(prb, console_seq, &r))
2665                         break;
2666
2667                 if (console_seq != r.info->seq) {
2668                         console_dropped += r.info->seq - console_seq;
2669                         console_seq = r.info->seq;
2670                 }
2671
2672                 if (suppress_message_printing(r.info->level)) {
2673                         /*
2674                          * Skip record we have buffered and already printed
2675                          * directly to the console when we received it, and
2676                          * record that has level above the console loglevel.
2677                          */
2678                         console_seq++;
2679                         goto skip;
2680                 }
2681
2682                 /* Output to all consoles once old messages replayed. */
2683                 if (unlikely(exclusive_console &&
2684                              console_seq >= exclusive_console_stop_seq)) {
2685                         exclusive_console = NULL;
2686                 }
2687
2688                 /*
2689                  * Handle extended console text first because later
2690                  * record_print_text() will modify the record buffer in-place.
2691                  */
2692                 if (nr_ext_console_drivers) {
2693                         ext_len = info_print_ext_header(ext_text,
2694                                                 sizeof(ext_text),
2695                                                 r.info);
2696                         ext_len += msg_print_ext_body(ext_text + ext_len,
2697                                                 sizeof(ext_text) - ext_len,
2698                                                 &r.text_buf[0],
2699                                                 r.info->text_len,
2700                                                 &r.info->dev_info);
2701                 }
2702                 len = record_print_text(&r,
2703                                 console_msg_format & MSG_FORMAT_SYSLOG,
2704                                 printk_time);
2705                 console_seq++;
2706
2707                 /*
2708                  * While actively printing out messages, if another printk()
2709                  * were to occur on another CPU, it may wait for this one to
2710                  * finish. This task can not be preempted if there is a
2711                  * waiter waiting to take over.
2712                  *
2713                  * Interrupts are disabled because the hand over to a waiter
2714                  * must not be interrupted until the hand over is completed
2715                  * (@console_waiter is cleared).
2716                  */
2717                 printk_safe_enter_irqsave(flags);
2718                 console_lock_spinning_enable();
2719
2720                 stop_critical_timings();        /* don't trace print latency */
2721                 call_console_drivers(ext_text, ext_len, text, len);
2722                 start_critical_timings();
2723
2724                 handover = console_lock_spinning_disable_and_check();
2725                 printk_safe_exit_irqrestore(flags);
2726                 if (handover)
2727                         return;
2728
2729                 if (do_cond_resched)
2730                         cond_resched();
2731         }
2732
2733         console_locked = 0;
2734
2735         up_console_sem();
2736
2737         /*
2738          * Someone could have filled up the buffer again, so re-check if there's
2739          * something to flush. In case we cannot trylock the console_sem again,
2740          * there's a new owner and the console_unlock() from them will do the
2741          * flush, no worries.
2742          */
2743         retry = prb_read_valid(prb, console_seq, NULL);
2744         if (retry && console_trylock())
2745                 goto again;
2746 }
2747 EXPORT_SYMBOL(console_unlock);
2748
2749 /**
2750  * console_conditional_schedule - yield the CPU if required
2751  *
2752  * If the console code is currently allowed to sleep, and
2753  * if this CPU should yield the CPU to another task, do
2754  * so here.
2755  *
2756  * Must be called within console_lock();.
2757  */
2758 void __sched console_conditional_schedule(void)
2759 {
2760         if (console_may_schedule)
2761                 cond_resched();
2762 }
2763 EXPORT_SYMBOL(console_conditional_schedule);
2764
2765 void console_unblank(void)
2766 {
2767         struct console *c;
2768
2769         /*
2770          * console_unblank can no longer be called in interrupt context unless
2771          * oops_in_progress is set to 1..
2772          */
2773         if (oops_in_progress) {
2774                 if (down_trylock_console_sem() != 0)
2775                         return;
2776         } else
2777                 console_lock();
2778
2779         console_locked = 1;
2780         console_may_schedule = 0;
2781         for_each_console(c)
2782                 if ((c->flags & CON_ENABLED) && c->unblank)
2783                         c->unblank();
2784         console_unlock();
2785 }
2786
2787 /**
2788  * console_flush_on_panic - flush console content on panic
2789  * @mode: flush all messages in buffer or just the pending ones
2790  *
2791  * Immediately output all pending messages no matter what.
2792  */
2793 void console_flush_on_panic(enum con_flush_mode mode)
2794 {
2795         /*
2796          * If someone else is holding the console lock, trylock will fail
2797          * and may_schedule may be set.  Ignore and proceed to unlock so
2798          * that messages are flushed out.  As this can be called from any
2799          * context and we don't want to get preempted while flushing,
2800          * ensure may_schedule is cleared.
2801          */
2802         console_trylock();
2803         console_may_schedule = 0;
2804
2805         if (mode == CONSOLE_REPLAY_ALL)
2806                 console_seq = prb_first_valid_seq(prb);
2807         console_unlock();
2808 }
2809
2810 /*
2811  * Return the console tty driver structure and its associated index
2812  */
2813 struct tty_driver *console_device(int *index)
2814 {
2815         struct console *c;
2816         struct tty_driver *driver = NULL;
2817
2818         console_lock();
2819         for_each_console(c) {
2820                 if (!c->device)
2821                         continue;
2822                 driver = c->device(c, index);
2823                 if (driver)
2824                         break;
2825         }
2826         console_unlock();
2827         return driver;
2828 }
2829
2830 /*
2831  * Prevent further output on the passed console device so that (for example)
2832  * serial drivers can disable console output before suspending a port, and can
2833  * re-enable output afterwards.
2834  */
2835 void console_stop(struct console *console)
2836 {
2837         console_lock();
2838         console->flags &= ~CON_ENABLED;
2839         console_unlock();
2840 }
2841 EXPORT_SYMBOL(console_stop);
2842
2843 void console_start(struct console *console)
2844 {
2845         console_lock();
2846         console->flags |= CON_ENABLED;
2847         console_unlock();
2848 }
2849 EXPORT_SYMBOL(console_start);
2850
2851 static int __read_mostly keep_bootcon;
2852
2853 static int __init keep_bootcon_setup(char *str)
2854 {
2855         keep_bootcon = 1;
2856         pr_info("debug: skip boot console de-registration.\n");
2857
2858         return 0;
2859 }
2860
2861 early_param("keep_bootcon", keep_bootcon_setup);
2862
2863 /*
2864  * This is called by register_console() to try to match
2865  * the newly registered console with any of the ones selected
2866  * by either the command line or add_preferred_console() and
2867  * setup/enable it.
2868  *
2869  * Care need to be taken with consoles that are statically
2870  * enabled such as netconsole
2871  */
2872 static int try_enable_new_console(struct console *newcon, bool user_specified)
2873 {
2874         struct console_cmdline *c;
2875         int i, err;
2876
2877         for (i = 0, c = console_cmdline;
2878              i < MAX_CMDLINECONSOLES && c->name[0];
2879              i++, c++) {
2880                 if (c->user_specified != user_specified)
2881                         continue;
2882                 if (!newcon->match ||
2883                     newcon->match(newcon, c->name, c->index, c->options) != 0) {
2884                         /* default matching */
2885                         BUILD_BUG_ON(sizeof(c->name) != sizeof(newcon->name));
2886                         if (strcmp(c->name, newcon->name) != 0)
2887                                 continue;
2888                         if (newcon->index >= 0 &&
2889                             newcon->index != c->index)
2890                                 continue;
2891                         if (newcon->index < 0)
2892                                 newcon->index = c->index;
2893
2894                         if (_braille_register_console(newcon, c))
2895                                 return 0;
2896
2897                         if (newcon->setup &&
2898                             (err = newcon->setup(newcon, c->options)) != 0)
2899                                 return err;
2900                 }
2901                 newcon->flags |= CON_ENABLED;
2902                 if (i == preferred_console) {
2903                         newcon->flags |= CON_CONSDEV;
2904                         has_preferred_console = true;
2905                 }
2906                 return 0;
2907         }
2908
2909         /*
2910          * Some consoles, such as pstore and netconsole, can be enabled even
2911          * without matching. Accept the pre-enabled consoles only when match()
2912          * and setup() had a chance to be called.
2913          */
2914         if (newcon->flags & CON_ENABLED && c->user_specified == user_specified)
2915                 return 0;
2916
2917         return -ENOENT;
2918 }
2919
2920 /*
2921  * The console driver calls this routine during kernel initialization
2922  * to register the console printing procedure with printk() and to
2923  * print any messages that were printed by the kernel before the
2924  * console driver was initialized.
2925  *
2926  * This can happen pretty early during the boot process (because of
2927  * early_printk) - sometimes before setup_arch() completes - be careful
2928  * of what kernel features are used - they may not be initialised yet.
2929  *
2930  * There are two types of consoles - bootconsoles (early_printk) and
2931  * "real" consoles (everything which is not a bootconsole) which are
2932  * handled differently.
2933  *  - Any number of bootconsoles can be registered at any time.
2934  *  - As soon as a "real" console is registered, all bootconsoles
2935  *    will be unregistered automatically.
2936  *  - Once a "real" console is registered, any attempt to register a
2937  *    bootconsoles will be rejected
2938  */
2939 void register_console(struct console *newcon)
2940 {
2941         struct console *bcon = NULL;
2942         int err;
2943
2944         for_each_console(bcon) {
2945                 if (WARN(bcon == newcon, "console '%s%d' already registered\n",
2946                                          bcon->name, bcon->index))
2947                         return;
2948         }
2949
2950         /*
2951          * before we register a new CON_BOOT console, make sure we don't
2952          * already have a valid console
2953          */
2954         if (newcon->flags & CON_BOOT) {
2955                 for_each_console(bcon) {
2956                         if (!(bcon->flags & CON_BOOT)) {
2957                                 pr_info("Too late to register bootconsole %s%d\n",
2958                                         newcon->name, newcon->index);
2959                                 return;
2960                         }
2961                 }
2962         }
2963
2964         if (console_drivers && console_drivers->flags & CON_BOOT)
2965                 bcon = console_drivers;
2966
2967         if (!has_preferred_console || bcon || !console_drivers)
2968                 has_preferred_console = preferred_console >= 0;
2969
2970         /*
2971          *      See if we want to use this console driver. If we
2972          *      didn't select a console we take the first one
2973          *      that registers here.
2974          */
2975         if (!has_preferred_console) {
2976                 if (newcon->index < 0)
2977                         newcon->index = 0;
2978                 if (newcon->setup == NULL ||
2979                     newcon->setup(newcon, NULL) == 0) {
2980                         newcon->flags |= CON_ENABLED;
2981                         if (newcon->device) {
2982                                 newcon->flags |= CON_CONSDEV;
2983                                 has_preferred_console = true;
2984                         }
2985                 }
2986         }
2987
2988         /* See if this console matches one we selected on the command line */
2989         err = try_enable_new_console(newcon, true);
2990
2991         /* If not, try to match against the platform default(s) */
2992         if (err == -ENOENT)
2993                 err = try_enable_new_console(newcon, false);
2994
2995         /* printk() messages are not printed to the Braille console. */
2996         if (err || newcon->flags & CON_BRL)
2997                 return;
2998
2999         /*
3000          * If we have a bootconsole, and are switching to a real console,
3001          * don't print everything out again, since when the boot console, and
3002          * the real console are the same physical device, it's annoying to
3003          * see the beginning boot messages twice
3004          */
3005         if (bcon && ((newcon->flags & (CON_CONSDEV | CON_BOOT)) == CON_CONSDEV))
3006                 newcon->flags &= ~CON_PRINTBUFFER;
3007
3008         /*
3009          *      Put this console in the list - keep the
3010          *      preferred driver at the head of the list.
3011          */
3012         console_lock();
3013         if ((newcon->flags & CON_CONSDEV) || console_drivers == NULL) {
3014                 newcon->next = console_drivers;
3015                 console_drivers = newcon;
3016                 if (newcon->next)
3017                         newcon->next->flags &= ~CON_CONSDEV;
3018                 /* Ensure this flag is always set for the head of the list */
3019                 newcon->flags |= CON_CONSDEV;
3020         } else {
3021                 newcon->next = console_drivers->next;
3022                 console_drivers->next = newcon;
3023         }
3024
3025         if (newcon->flags & CON_EXTENDED)
3026                 nr_ext_console_drivers++;
3027
3028         if (newcon->flags & CON_PRINTBUFFER) {
3029                 /*
3030                  * console_unlock(); will print out the buffered messages
3031                  * for us.
3032                  *
3033                  * We're about to replay the log buffer.  Only do this to the
3034                  * just-registered console to avoid excessive message spam to
3035                  * the already-registered consoles.
3036                  *
3037                  * Set exclusive_console with disabled interrupts to reduce
3038                  * race window with eventual console_flush_on_panic() that
3039                  * ignores console_lock.
3040                  */
3041                 exclusive_console = newcon;
3042                 exclusive_console_stop_seq = console_seq;
3043
3044                 /* Get a consistent copy of @syslog_seq. */
3045                 mutex_lock(&syslog_lock);
3046                 console_seq = syslog_seq;
3047                 mutex_unlock(&syslog_lock);
3048         }
3049         console_unlock();
3050         console_sysfs_notify();
3051
3052         /*
3053          * By unregistering the bootconsoles after we enable the real console
3054          * we get the "console xxx enabled" message on all the consoles -
3055          * boot consoles, real consoles, etc - this is to ensure that end
3056          * users know there might be something in the kernel's log buffer that
3057          * went to the bootconsole (that they do not see on the real console)
3058          */
3059         pr_info("%sconsole [%s%d] enabled\n",
3060                 (newcon->flags & CON_BOOT) ? "boot" : "" ,
3061                 newcon->name, newcon->index);
3062         if (bcon &&
3063             ((newcon->flags & (CON_CONSDEV | CON_BOOT)) == CON_CONSDEV) &&
3064             !keep_bootcon) {
3065                 /* We need to iterate through all boot consoles, to make
3066                  * sure we print everything out, before we unregister them.
3067                  */
3068                 for_each_console(bcon)
3069                         if (bcon->flags & CON_BOOT)
3070                                 unregister_console(bcon);
3071         }
3072 }
3073 EXPORT_SYMBOL(register_console);
3074
3075 int unregister_console(struct console *console)
3076 {
3077         struct console *con;
3078         int res;
3079
3080         pr_info("%sconsole [%s%d] disabled\n",
3081                 (console->flags & CON_BOOT) ? "boot" : "" ,
3082                 console->name, console->index);
3083
3084         res = _braille_unregister_console(console);
3085         if (res < 0)
3086                 return res;
3087         if (res > 0)
3088                 return 0;
3089
3090         res = -ENODEV;
3091         console_lock();
3092         if (console_drivers == console) {
3093                 console_drivers=console->next;
3094                 res = 0;
3095         } else {
3096                 for_each_console(con) {
3097                         if (con->next == console) {
3098                                 con->next = console->next;
3099                                 res = 0;
3100                                 break;
3101                         }
3102                 }
3103         }
3104
3105         if (res)
3106                 goto out_disable_unlock;
3107
3108         if (console->flags & CON_EXTENDED)
3109                 nr_ext_console_drivers--;
3110
3111         /*
3112          * If this isn't the last console and it has CON_CONSDEV set, we
3113          * need to set it on the next preferred console.
3114          */
3115         if (console_drivers != NULL && console->flags & CON_CONSDEV)
3116                 console_drivers->flags |= CON_CONSDEV;
3117
3118         console->flags &= ~CON_ENABLED;
3119         console_unlock();
3120         console_sysfs_notify();
3121
3122         if (console->exit)
3123                 res = console->exit(console);
3124
3125         return res;
3126
3127 out_disable_unlock:
3128         console->flags &= ~CON_ENABLED;
3129         console_unlock();
3130
3131         return res;
3132 }
3133 EXPORT_SYMBOL(unregister_console);
3134
3135 /*
3136  * Initialize the console device. This is called *early*, so
3137  * we can't necessarily depend on lots of kernel help here.
3138  * Just do some early initializations, and do the complex setup
3139  * later.
3140  */
3141 void __init console_init(void)
3142 {
3143         int ret;
3144         initcall_t call;
3145         initcall_entry_t *ce;
3146
3147         /* Setup the default TTY line discipline. */
3148         n_tty_init();
3149
3150         /*
3151          * set up the console device so that later boot sequences can
3152          * inform about problems etc..
3153          */
3154         ce = __con_initcall_start;
3155         trace_initcall_level("console");
3156         while (ce < __con_initcall_end) {
3157                 call = initcall_from_entry(ce);
3158                 trace_initcall_start(call);
3159                 ret = call();
3160                 trace_initcall_finish(call, ret);
3161                 ce++;
3162         }
3163 }
3164
3165 /*
3166  * Some boot consoles access data that is in the init section and which will
3167  * be discarded after the initcalls have been run. To make sure that no code
3168  * will access this data, unregister the boot consoles in a late initcall.
3169  *
3170  * If for some reason, such as deferred probe or the driver being a loadable
3171  * module, the real console hasn't registered yet at this point, there will
3172  * be a brief interval in which no messages are logged to the console, which
3173  * makes it difficult to diagnose problems that occur during this time.
3174  *
3175  * To mitigate this problem somewhat, only unregister consoles whose memory
3176  * intersects with the init section. Note that all other boot consoles will
3177  * get unregistered when the real preferred console is registered.
3178  */
3179 static int __init printk_late_init(void)
3180 {
3181         struct console *con;
3182         int ret;
3183
3184         for_each_console(con) {
3185                 if (!(con->flags & CON_BOOT))
3186                         continue;
3187
3188                 /* Check addresses that might be used for enabled consoles. */
3189                 if (init_section_intersects(con, sizeof(*con)) ||
3190                     init_section_contains(con->write, 0) ||
3191                     init_section_contains(con->read, 0) ||
3192                     init_section_contains(con->device, 0) ||
3193                     init_section_contains(con->unblank, 0) ||
3194                     init_section_contains(con->data, 0)) {
3195                         /*
3196                          * Please, consider moving the reported consoles out
3197                          * of the init section.
3198                          */
3199                         pr_warn("bootconsole [%s%d] uses init memory and must be disabled even before the real one is ready\n",
3200                                 con->name, con->index);
3201                         unregister_console(con);
3202                 }
3203         }
3204         ret = cpuhp_setup_state_nocalls(CPUHP_PRINTK_DEAD, "printk:dead", NULL,
3205                                         console_cpu_notify);
3206         WARN_ON(ret < 0);
3207         ret = cpuhp_setup_state_nocalls(CPUHP_AP_ONLINE_DYN, "printk:online",
3208                                         console_cpu_notify, NULL);
3209         WARN_ON(ret < 0);
3210         return 0;
3211 }
3212 late_initcall(printk_late_init);
3213
3214 #if defined CONFIG_PRINTK
3215 /*
3216  * Delayed printk version, for scheduler-internal messages:
3217  */
3218 #define PRINTK_PENDING_WAKEUP   0x01
3219 #define PRINTK_PENDING_OUTPUT   0x02
3220
3221 static DEFINE_PER_CPU(int, printk_pending);
3222
3223 static void wake_up_klogd_work_func(struct irq_work *irq_work)
3224 {
3225         int pending = __this_cpu_xchg(printk_pending, 0);
3226
3227         if (pending & PRINTK_PENDING_OUTPUT) {
3228                 /* If trylock fails, someone else is doing the printing */
3229                 if (console_trylock())
3230                         console_unlock();
3231         }
3232
3233         if (pending & PRINTK_PENDING_WAKEUP)
3234                 wake_up_interruptible(&log_wait);
3235 }
3236
3237 static DEFINE_PER_CPU(struct irq_work, wake_up_klogd_work) =
3238         IRQ_WORK_INIT_LAZY(wake_up_klogd_work_func);
3239
3240 void wake_up_klogd(void)
3241 {
3242         if (!printk_percpu_data_ready())
3243                 return;
3244
3245         preempt_disable();
3246         if (waitqueue_active(&log_wait)) {
3247                 this_cpu_or(printk_pending, PRINTK_PENDING_WAKEUP);
3248                 irq_work_queue(this_cpu_ptr(&wake_up_klogd_work));
3249         }
3250         preempt_enable();
3251 }
3252
3253 void defer_console_output(void)
3254 {
3255         if (!printk_percpu_data_ready())
3256                 return;
3257
3258         preempt_disable();
3259         __this_cpu_or(printk_pending, PRINTK_PENDING_OUTPUT);
3260         irq_work_queue(this_cpu_ptr(&wake_up_klogd_work));
3261         preempt_enable();
3262 }
3263
3264 int vprintk_deferred(const char *fmt, va_list args)
3265 {
3266         int r;
3267
3268         r = vprintk_emit(0, LOGLEVEL_SCHED, NULL, fmt, args);
3269         defer_console_output();
3270
3271         return r;
3272 }
3273
3274 int printk_deferred(const char *fmt, ...)
3275 {
3276         va_list args;
3277         int r;
3278
3279         va_start(args, fmt);
3280         r = vprintk_deferred(fmt, args);
3281         va_end(args);
3282
3283         return r;
3284 }
3285
3286 /*
3287  * printk rate limiting, lifted from the networking subsystem.
3288  *
3289  * This enforces a rate limit: not more than 10 kernel messages
3290  * every 5s to make a denial-of-service attack impossible.
3291  */
3292 DEFINE_RATELIMIT_STATE(printk_ratelimit_state, 5 * HZ, 10);
3293
3294 int __printk_ratelimit(const char *func)
3295 {
3296         return ___ratelimit(&printk_ratelimit_state, func);
3297 }
3298 EXPORT_SYMBOL(__printk_ratelimit);
3299
3300 /**
3301  * printk_timed_ratelimit - caller-controlled printk ratelimiting
3302  * @caller_jiffies: pointer to caller's state
3303  * @interval_msecs: minimum interval between prints
3304  *
3305  * printk_timed_ratelimit() returns true if more than @interval_msecs
3306  * milliseconds have elapsed since the last time printk_timed_ratelimit()
3307  * returned true.
3308  */
3309 bool printk_timed_ratelimit(unsigned long *caller_jiffies,
3310                         unsigned int interval_msecs)
3311 {
3312         unsigned long elapsed = jiffies - *caller_jiffies;
3313
3314         if (*caller_jiffies && elapsed <= msecs_to_jiffies(interval_msecs))
3315                 return false;
3316
3317         *caller_jiffies = jiffies;
3318         return true;
3319 }
3320 EXPORT_SYMBOL(printk_timed_ratelimit);
3321
3322 static DEFINE_SPINLOCK(dump_list_lock);
3323 static LIST_HEAD(dump_list);
3324
3325 /**
3326  * kmsg_dump_register - register a kernel log dumper.
3327  * @dumper: pointer to the kmsg_dumper structure
3328  *
3329  * Adds a kernel log dumper to the system. The dump callback in the
3330  * structure will be called when the kernel oopses or panics and must be
3331  * set. Returns zero on success and %-EINVAL or %-EBUSY otherwise.
3332  */
3333 int kmsg_dump_register(struct kmsg_dumper *dumper)
3334 {
3335         unsigned long flags;
3336         int err = -EBUSY;
3337
3338         /* The dump callback needs to be set */
3339         if (!dumper->dump)
3340                 return -EINVAL;
3341
3342         spin_lock_irqsave(&dump_list_lock, flags);
3343         /* Don't allow registering multiple times */
3344         if (!dumper->registered) {
3345                 dumper->registered = 1;
3346                 list_add_tail_rcu(&dumper->list, &dump_list);
3347                 err = 0;
3348         }
3349         spin_unlock_irqrestore(&dump_list_lock, flags);
3350
3351         return err;
3352 }
3353 EXPORT_SYMBOL_GPL(kmsg_dump_register);
3354
3355 /**
3356  * kmsg_dump_unregister - unregister a kmsg dumper.
3357  * @dumper: pointer to the kmsg_dumper structure
3358  *
3359  * Removes a dump device from the system. Returns zero on success and
3360  * %-EINVAL otherwise.
3361  */
3362 int kmsg_dump_unregister(struct kmsg_dumper *dumper)
3363 {
3364         unsigned long flags;
3365         int err = -EINVAL;
3366
3367         spin_lock_irqsave(&dump_list_lock, flags);
3368         if (dumper->registered) {
3369                 dumper->registered = 0;
3370                 list_del_rcu(&dumper->list);
3371                 err = 0;
3372         }
3373         spin_unlock_irqrestore(&dump_list_lock, flags);
3374         synchronize_rcu();
3375
3376         return err;
3377 }
3378 EXPORT_SYMBOL_GPL(kmsg_dump_unregister);
3379
3380 static bool always_kmsg_dump;
3381 module_param_named(always_kmsg_dump, always_kmsg_dump, bool, S_IRUGO | S_IWUSR);
3382
3383 const char *kmsg_dump_reason_str(enum kmsg_dump_reason reason)
3384 {
3385         switch (reason) {
3386         case KMSG_DUMP_PANIC:
3387                 return "Panic";
3388         case KMSG_DUMP_OOPS:
3389                 return "Oops";
3390         case KMSG_DUMP_EMERG:
3391                 return "Emergency";
3392         case KMSG_DUMP_SHUTDOWN:
3393                 return "Shutdown";
3394         default:
3395                 return "Unknown";
3396         }
3397 }
3398 EXPORT_SYMBOL_GPL(kmsg_dump_reason_str);
3399
3400 /**
3401  * kmsg_dump - dump kernel log to kernel message dumpers.
3402  * @reason: the reason (oops, panic etc) for dumping
3403  *
3404  * Call each of the registered dumper's dump() callback, which can
3405  * retrieve the kmsg records with kmsg_dump_get_line() or
3406  * kmsg_dump_get_buffer().
3407  */
3408 void kmsg_dump(enum kmsg_dump_reason reason)
3409 {
3410         struct kmsg_dumper *dumper;
3411
3412         rcu_read_lock();
3413         list_for_each_entry_rcu(dumper, &dump_list, list) {
3414                 enum kmsg_dump_reason max_reason = dumper->max_reason;
3415
3416                 /*
3417                  * If client has not provided a specific max_reason, default
3418                  * to KMSG_DUMP_OOPS, unless always_kmsg_dump was set.
3419                  */
3420                 if (max_reason == KMSG_DUMP_UNDEF) {
3421                         max_reason = always_kmsg_dump ? KMSG_DUMP_MAX :
3422                                                         KMSG_DUMP_OOPS;
3423                 }
3424                 if (reason > max_reason)
3425                         continue;
3426
3427                 /* invoke dumper which will iterate over records */
3428                 dumper->dump(dumper, reason);
3429         }
3430         rcu_read_unlock();
3431 }
3432
3433 /**
3434  * kmsg_dump_get_line - retrieve one kmsg log line
3435  * @iter: kmsg dump iterator
3436  * @syslog: include the "<4>" prefixes
3437  * @line: buffer to copy the line to
3438  * @size: maximum size of the buffer
3439  * @len: length of line placed into buffer
3440  *
3441  * Start at the beginning of the kmsg buffer, with the oldest kmsg
3442  * record, and copy one record into the provided buffer.
3443  *
3444  * Consecutive calls will return the next available record moving
3445  * towards the end of the buffer with the youngest messages.
3446  *
3447  * A return value of FALSE indicates that there are no more records to
3448  * read.
3449  */
3450 bool kmsg_dump_get_line(struct kmsg_dump_iter *iter, bool syslog,
3451                         char *line, size_t size, size_t *len)
3452 {
3453         u64 min_seq = latched_seq_read_nolock(&clear_seq);
3454         struct printk_info info;
3455         unsigned int line_count;
3456         struct printk_record r;
3457         size_t l = 0;
3458         bool ret = false;
3459
3460         if (iter->cur_seq < min_seq)
3461                 iter->cur_seq = min_seq;
3462
3463         prb_rec_init_rd(&r, &info, line, size);
3464
3465         /* Read text or count text lines? */
3466         if (line) {
3467                 if (!prb_read_valid(prb, iter->cur_seq, &r))
3468                         goto out;
3469                 l = record_print_text(&r, syslog, printk_time);
3470         } else {
3471                 if (!prb_read_valid_info(prb, iter->cur_seq,
3472                                          &info, &line_count)) {
3473                         goto out;
3474                 }
3475                 l = get_record_print_text_size(&info, line_count, syslog,
3476                                                printk_time);
3477
3478         }
3479
3480         iter->cur_seq = r.info->seq + 1;
3481         ret = true;
3482 out:
3483         if (len)
3484                 *len = l;
3485         return ret;
3486 }
3487 EXPORT_SYMBOL_GPL(kmsg_dump_get_line);
3488
3489 /**
3490  * kmsg_dump_get_buffer - copy kmsg log lines
3491  * @iter: kmsg dump iterator
3492  * @syslog: include the "<4>" prefixes
3493  * @buf: buffer to copy the line to
3494  * @size: maximum size of the buffer
3495  * @len_out: length of line placed into buffer
3496  *
3497  * Start at the end of the kmsg buffer and fill the provided buffer
3498  * with as many of the *youngest* kmsg records that fit into it.
3499  * If the buffer is large enough, all available kmsg records will be
3500  * copied with a single call.
3501  *
3502  * Consecutive calls will fill the buffer with the next block of
3503  * available older records, not including the earlier retrieved ones.
3504  *
3505  * A return value of FALSE indicates that there are no more records to
3506  * read.
3507  */
3508 bool kmsg_dump_get_buffer(struct kmsg_dump_iter *iter, bool syslog,
3509                           char *buf, size_t size, size_t *len_out)
3510 {
3511         u64 min_seq = latched_seq_read_nolock(&clear_seq);
3512         struct printk_info info;
3513         struct printk_record r;
3514         u64 seq;
3515         u64 next_seq;
3516         size_t len = 0;
3517         bool ret = false;
3518         bool time = printk_time;
3519
3520         if (!buf || !size)
3521                 goto out;
3522
3523         if (iter->cur_seq < min_seq)
3524                 iter->cur_seq = min_seq;
3525
3526         if (prb_read_valid_info(prb, iter->cur_seq, &info, NULL)) {
3527                 if (info.seq != iter->cur_seq) {
3528                         /* messages are gone, move to first available one */
3529                         iter->cur_seq = info.seq;
3530                 }
3531         }
3532
3533         /* last entry */
3534         if (iter->cur_seq >= iter->next_seq)
3535                 goto out;
3536
3537         /*
3538          * Find first record that fits, including all following records,
3539          * into the user-provided buffer for this dump. Pass in size-1
3540          * because this function (by way of record_print_text()) will
3541          * not write more than size-1 bytes of text into @buf.
3542          */
3543         seq = find_first_fitting_seq(iter->cur_seq, iter->next_seq,
3544                                      size - 1, syslog, time);
3545
3546         /*
3547          * Next kmsg_dump_get_buffer() invocation will dump block of
3548          * older records stored right before this one.
3549          */
3550         next_seq = seq;
3551
3552         prb_rec_init_rd(&r, &info, buf, size);
3553
3554         len = 0;
3555         prb_for_each_record(seq, prb, seq, &r) {
3556                 if (r.info->seq >= iter->next_seq)
3557                         break;
3558
3559                 len += record_print_text(&r, syslog, time);
3560
3561                 /* Adjust record to store to remaining buffer space. */
3562                 prb_rec_init_rd(&r, &info, buf + len, size - len);
3563         }
3564
3565         iter->next_seq = next_seq;
3566         ret = true;
3567 out:
3568         if (len_out)
3569                 *len_out = len;
3570         return ret;
3571 }
3572 EXPORT_SYMBOL_GPL(kmsg_dump_get_buffer);
3573
3574 /**
3575  * kmsg_dump_rewind - reset the iterator
3576  * @iter: kmsg dump iterator
3577  *
3578  * Reset the dumper's iterator so that kmsg_dump_get_line() and
3579  * kmsg_dump_get_buffer() can be called again and used multiple
3580  * times within the same dumper.dump() callback.
3581  */
3582 void kmsg_dump_rewind(struct kmsg_dump_iter *iter)
3583 {
3584         iter->cur_seq = latched_seq_read_nolock(&clear_seq);
3585         iter->next_seq = prb_next_seq(prb);
3586 }
3587 EXPORT_SYMBOL_GPL(kmsg_dump_rewind);
3588
3589 #endif
3590
3591 #ifdef CONFIG_SMP
3592 static atomic_t printk_cpulock_owner = ATOMIC_INIT(-1);
3593 static atomic_t printk_cpulock_nested = ATOMIC_INIT(0);
3594
3595 /**
3596  * __printk_wait_on_cpu_lock() - Busy wait until the printk cpu-reentrant
3597  *                               spinning lock is not owned by any CPU.
3598  *
3599  * Context: Any context.
3600  */
3601 void __printk_wait_on_cpu_lock(void)
3602 {
3603         do {
3604                 cpu_relax();
3605         } while (atomic_read(&printk_cpulock_owner) != -1);
3606 }
3607 EXPORT_SYMBOL(__printk_wait_on_cpu_lock);
3608
3609 /**
3610  * __printk_cpu_trylock() - Try to acquire the printk cpu-reentrant
3611  *                          spinning lock.
3612  *
3613  * If no processor has the lock, the calling processor takes the lock and
3614  * becomes the owner. If the calling processor is already the owner of the
3615  * lock, this function succeeds immediately.
3616  *
3617  * Context: Any context. Expects interrupts to be disabled.
3618  * Return: 1 on success, otherwise 0.
3619  */
3620 int __printk_cpu_trylock(void)
3621 {
3622         int cpu;
3623         int old;
3624
3625         cpu = smp_processor_id();
3626
3627         /*
3628          * Guarantee loads and stores from this CPU when it is the lock owner
3629          * are _not_ visible to the previous lock owner. This pairs with
3630          * __printk_cpu_unlock:B.
3631          *
3632          * Memory barrier involvement:
3633          *
3634          * If __printk_cpu_trylock:A reads from __printk_cpu_unlock:B, then
3635          * __printk_cpu_unlock:A can never read from __printk_cpu_trylock:B.
3636          *
3637          * Relies on:
3638          *
3639          * RELEASE from __printk_cpu_unlock:A to __printk_cpu_unlock:B
3640          * of the previous CPU
3641          *    matching
3642          * ACQUIRE from __printk_cpu_trylock:A to __printk_cpu_trylock:B
3643          * of this CPU
3644          */
3645         old = atomic_cmpxchg_acquire(&printk_cpulock_owner, -1,
3646                                      cpu); /* LMM(__printk_cpu_trylock:A) */
3647         if (old == -1) {
3648                 /*
3649                  * This CPU is now the owner and begins loading/storing
3650                  * data: LMM(__printk_cpu_trylock:B)
3651                  */
3652                 return 1;
3653
3654         } else if (old == cpu) {
3655                 /* This CPU is already the owner. */
3656                 atomic_inc(&printk_cpulock_nested);
3657                 return 1;
3658         }
3659
3660         return 0;
3661 }
3662 EXPORT_SYMBOL(__printk_cpu_trylock);
3663
3664 /**
3665  * __printk_cpu_unlock() - Release the printk cpu-reentrant spinning lock.
3666  *
3667  * The calling processor must be the owner of the lock.
3668  *
3669  * Context: Any context. Expects interrupts to be disabled.
3670  */
3671 void __printk_cpu_unlock(void)
3672 {
3673         if (atomic_read(&printk_cpulock_nested)) {
3674                 atomic_dec(&printk_cpulock_nested);
3675                 return;
3676         }
3677
3678         /*
3679          * This CPU is finished loading/storing data:
3680          * LMM(__printk_cpu_unlock:A)
3681          */
3682
3683         /*
3684          * Guarantee loads and stores from this CPU when it was the
3685          * lock owner are visible to the next lock owner. This pairs
3686          * with __printk_cpu_trylock:A.
3687          *
3688          * Memory barrier involvement:
3689          *
3690          * If __printk_cpu_trylock:A reads from __printk_cpu_unlock:B,
3691          * then __printk_cpu_trylock:B reads from __printk_cpu_unlock:A.
3692          *
3693          * Relies on:
3694          *
3695          * RELEASE from __printk_cpu_unlock:A to __printk_cpu_unlock:B
3696          * of this CPU
3697          *    matching
3698          * ACQUIRE from __printk_cpu_trylock:A to __printk_cpu_trylock:B
3699          * of the next CPU
3700          */
3701         atomic_set_release(&printk_cpulock_owner,
3702                            -1); /* LMM(__printk_cpu_unlock:B) */
3703 }
3704 EXPORT_SYMBOL(__printk_cpu_unlock);
3705 #endif /* CONFIG_SMP */