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