1 // SPDX-License-Identifier: GPL-2.0-or-later
2 /*
3 * linux/drivers/net/netconsole.c
4 *
5 * Copyright (C) 2001 Ingo Molnar <mingo@redhat.com>
6 *
7 * This file contains the implementation of an IRQ-safe, crash-safe
8 * kernel console implementation that outputs kernel messages to the
9 * network.
10 *
11 * Modification history:
12 *
13 * 2001-09-17 started by Ingo Molnar.
14 * 2003-08-11 2.6 port by Matt Mackall
15 * simplified options
16 * generic card hooks
17 * works non-modular
18 * 2003-09-07 rewritten with netpoll api
19 */
20
21 /****************************************************************
22 *
23 ****************************************************************/
24
25 #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
26
27 #include <linux/mm.h>
28 #include <linux/init.h>
29 #include <linux/module.h>
30 #include <linux/slab.h>
31 #include <linux/console.h>
32 #include <linux/moduleparam.h>
33 #include <linux/kernel.h>
34 #include <linux/string.h>
35 #include <linux/netpoll.h>
36 #include <linux/inet.h>
37 #include <linux/configfs.h>
38 #include <linux/etherdevice.h>
39
40 MODULE_AUTHOR("Maintainer: Matt Mackall <mpm@selenic.com>");
41 MODULE_DESCRIPTION("Console driver for network interfaces");
42 MODULE_LICENSE("GPL");
43
44 #define MAX_PARAM_LENGTH 256
45 #define MAX_PRINT_CHUNK 1000
46
47 static char config[MAX_PARAM_LENGTH];
48 module_param_string(netconsole, config, MAX_PARAM_LENGTH, 0);
49 MODULE_PARM_DESC(netconsole, " netconsole=[src-port]@[src-ip]/[dev],[tgt-port]@<tgt-ip>/[tgt-macaddr]");
50
51 static bool oops_only = false;
52 module_param(oops_only, bool, 0600);
53 MODULE_PARM_DESC(oops_only, "Only log oops messages");
54
55 #ifndef MODULE
option_setup(char * opt)56 static int __init option_setup(char *opt)
57 {
58 strlcpy(config, opt, MAX_PARAM_LENGTH);
59 return 1;
60 }
61 __setup("netconsole=", option_setup);
62 #endif /* MODULE */
63
64 /* Linked list of all configured targets */
65 static LIST_HEAD(target_list);
66
67 /* This needs to be a spinlock because write_msg() cannot sleep */
68 static DEFINE_SPINLOCK(target_list_lock);
69
70 /*
71 * Console driver for extended netconsoles. Registered on the first use to
72 * avoid unnecessarily enabling ext message formatting.
73 */
74 static struct console netconsole_ext;
75
76 /**
77 * struct netconsole_target - Represents a configured netconsole target.
78 * @list: Links this target into the target_list.
79 * @item: Links us into the configfs subsystem hierarchy.
80 * @enabled: On / off knob to enable / disable target.
81 * Visible from userspace (read-write).
82 * We maintain a strict 1:1 correspondence between this and
83 * whether the corresponding netpoll is active or inactive.
84 * Also, other parameters of a target may be modified at
85 * runtime only when it is disabled (enabled == 0).
86 * @np: The netpoll structure for this target.
87 * Contains the other userspace visible parameters:
88 * dev_name (read-write)
89 * local_port (read-write)
90 * remote_port (read-write)
91 * local_ip (read-write)
92 * remote_ip (read-write)
93 * local_mac (read-only)
94 * remote_mac (read-write)
95 */
96 struct netconsole_target {
97 struct list_head list;
98 #ifdef CONFIG_NETCONSOLE_DYNAMIC
99 struct config_item item;
100 #endif
101 bool enabled;
102 bool extended;
103 struct netpoll np;
104 };
105
106 #ifdef CONFIG_NETCONSOLE_DYNAMIC
107
108 static struct configfs_subsystem netconsole_subsys;
109 static DEFINE_MUTEX(dynamic_netconsole_mutex);
110
dynamic_netconsole_init(void)111 static int __init dynamic_netconsole_init(void)
112 {
113 config_group_init(&netconsole_subsys.su_group);
114 mutex_init(&netconsole_subsys.su_mutex);
115 return configfs_register_subsystem(&netconsole_subsys);
116 }
117
dynamic_netconsole_exit(void)118 static void __exit dynamic_netconsole_exit(void)
119 {
120 configfs_unregister_subsystem(&netconsole_subsys);
121 }
122
123 /*
124 * Targets that were created by parsing the boot/module option string
125 * do not exist in the configfs hierarchy (and have NULL names) and will
126 * never go away, so make these a no-op for them.
127 */
netconsole_target_get(struct netconsole_target * nt)128 static void netconsole_target_get(struct netconsole_target *nt)
129 {
130 if (config_item_name(&nt->item))
131 config_item_get(&nt->item);
132 }
133
netconsole_target_put(struct netconsole_target * nt)134 static void netconsole_target_put(struct netconsole_target *nt)
135 {
136 if (config_item_name(&nt->item))
137 config_item_put(&nt->item);
138 }
139
140 #else /* !CONFIG_NETCONSOLE_DYNAMIC */
141
dynamic_netconsole_init(void)142 static int __init dynamic_netconsole_init(void)
143 {
144 return 0;
145 }
146
dynamic_netconsole_exit(void)147 static void __exit dynamic_netconsole_exit(void)
148 {
149 }
150
151 /*
152 * No danger of targets going away from under us when dynamic
153 * reconfigurability is off.
154 */
netconsole_target_get(struct netconsole_target * nt)155 static void netconsole_target_get(struct netconsole_target *nt)
156 {
157 }
158
netconsole_target_put(struct netconsole_target * nt)159 static void netconsole_target_put(struct netconsole_target *nt)
160 {
161 }
162
163 #endif /* CONFIG_NETCONSOLE_DYNAMIC */
164
165 /* Allocate new target (from boot/module param) and setup netpoll for it */
alloc_param_target(char * target_config)166 static struct netconsole_target *alloc_param_target(char *target_config)
167 {
168 int err = -ENOMEM;
169 struct netconsole_target *nt;
170
171 /*
172 * Allocate and initialize with defaults.
173 * Note that these targets get their config_item fields zeroed-out.
174 */
175 nt = kzalloc(sizeof(*nt), GFP_KERNEL);
176 if (!nt)
177 goto fail;
178
179 nt->np.name = "netconsole";
180 strlcpy(nt->np.dev_name, "eth0", IFNAMSIZ);
181 nt->np.local_port = 6665;
182 nt->np.remote_port = 6666;
183 eth_broadcast_addr(nt->np.remote_mac);
184
185 if (*target_config == '+') {
186 nt->extended = true;
187 target_config++;
188 }
189
190 /* Parse parameters and setup netpoll */
191 err = netpoll_parse_options(&nt->np, target_config);
192 if (err)
193 goto fail;
194
195 err = netpoll_setup(&nt->np);
196 if (err)
197 goto fail;
198
199 nt->enabled = true;
200
201 return nt;
202
203 fail:
204 kfree(nt);
205 return ERR_PTR(err);
206 }
207
208 /* Cleanup netpoll for given target (from boot/module param) and free it */
free_param_target(struct netconsole_target * nt)209 static void free_param_target(struct netconsole_target *nt)
210 {
211 netpoll_cleanup(&nt->np);
212 kfree(nt);
213 }
214
215 #ifdef CONFIG_NETCONSOLE_DYNAMIC
216
217 /*
218 * Our subsystem hierarchy is:
219 *
220 * /sys/kernel/config/netconsole/
221 * |
222 * <target>/
223 * | enabled
224 * | dev_name
225 * | local_port
226 * | remote_port
227 * | local_ip
228 * | remote_ip
229 * | local_mac
230 * | remote_mac
231 * |
232 * <target>/...
233 */
234
to_target(struct config_item * item)235 static struct netconsole_target *to_target(struct config_item *item)
236 {
237 return item ?
238 container_of(item, struct netconsole_target, item) :
239 NULL;
240 }
241
242 /*
243 * Attribute operations for netconsole_target.
244 */
245
enabled_show(struct config_item * item,char * buf)246 static ssize_t enabled_show(struct config_item *item, char *buf)
247 {
248 return snprintf(buf, PAGE_SIZE, "%d\n", to_target(item)->enabled);
249 }
250
extended_show(struct config_item * item,char * buf)251 static ssize_t extended_show(struct config_item *item, char *buf)
252 {
253 return snprintf(buf, PAGE_SIZE, "%d\n", to_target(item)->extended);
254 }
255
dev_name_show(struct config_item * item,char * buf)256 static ssize_t dev_name_show(struct config_item *item, char *buf)
257 {
258 return snprintf(buf, PAGE_SIZE, "%s\n", to_target(item)->np.dev_name);
259 }
260
local_port_show(struct config_item * item,char * buf)261 static ssize_t local_port_show(struct config_item *item, char *buf)
262 {
263 return snprintf(buf, PAGE_SIZE, "%d\n", to_target(item)->np.local_port);
264 }
265
remote_port_show(struct config_item * item,char * buf)266 static ssize_t remote_port_show(struct config_item *item, char *buf)
267 {
268 return snprintf(buf, PAGE_SIZE, "%d\n", to_target(item)->np.remote_port);
269 }
270
local_ip_show(struct config_item * item,char * buf)271 static ssize_t local_ip_show(struct config_item *item, char *buf)
272 {
273 struct netconsole_target *nt = to_target(item);
274
275 if (nt->np.ipv6)
276 return snprintf(buf, PAGE_SIZE, "%pI6c\n", &nt->np.local_ip.in6);
277 else
278 return snprintf(buf, PAGE_SIZE, "%pI4\n", &nt->np.local_ip);
279 }
280
remote_ip_show(struct config_item * item,char * buf)281 static ssize_t remote_ip_show(struct config_item *item, char *buf)
282 {
283 struct netconsole_target *nt = to_target(item);
284
285 if (nt->np.ipv6)
286 return snprintf(buf, PAGE_SIZE, "%pI6c\n", &nt->np.remote_ip.in6);
287 else
288 return snprintf(buf, PAGE_SIZE, "%pI4\n", &nt->np.remote_ip);
289 }
290
local_mac_show(struct config_item * item,char * buf)291 static ssize_t local_mac_show(struct config_item *item, char *buf)
292 {
293 struct net_device *dev = to_target(item)->np.dev;
294 static const u8 bcast[ETH_ALEN] = { 0xff, 0xff, 0xff, 0xff, 0xff, 0xff };
295
296 return snprintf(buf, PAGE_SIZE, "%pM\n", dev ? dev->dev_addr : bcast);
297 }
298
remote_mac_show(struct config_item * item,char * buf)299 static ssize_t remote_mac_show(struct config_item *item, char *buf)
300 {
301 return snprintf(buf, PAGE_SIZE, "%pM\n", to_target(item)->np.remote_mac);
302 }
303
304 /*
305 * This one is special -- targets created through the configfs interface
306 * are not enabled (and the corresponding netpoll activated) by default.
307 * The user is expected to set the desired parameters first (which
308 * would enable him to dynamically add new netpoll targets for new
309 * network interfaces as and when they come up).
310 */
enabled_store(struct config_item * item,const char * buf,size_t count)311 static ssize_t enabled_store(struct config_item *item,
312 const char *buf, size_t count)
313 {
314 struct netconsole_target *nt = to_target(item);
315 unsigned long flags;
316 int enabled;
317 int err;
318
319 mutex_lock(&dynamic_netconsole_mutex);
320 err = kstrtoint(buf, 10, &enabled);
321 if (err < 0)
322 goto out_unlock;
323
324 err = -EINVAL;
325 if (enabled < 0 || enabled > 1)
326 goto out_unlock;
327 if ((bool)enabled == nt->enabled) {
328 pr_info("network logging has already %s\n",
329 nt->enabled ? "started" : "stopped");
330 goto out_unlock;
331 }
332
333 if (enabled) { /* true */
334 if (nt->extended && !(netconsole_ext.flags & CON_ENABLED)) {
335 netconsole_ext.flags |= CON_ENABLED;
336 register_console(&netconsole_ext);
337 }
338
339 /*
340 * Skip netpoll_parse_options() -- all the attributes are
341 * already configured via configfs. Just print them out.
342 */
343 netpoll_print_options(&nt->np);
344
345 err = netpoll_setup(&nt->np);
346 if (err)
347 goto out_unlock;
348
349 pr_info("network logging started\n");
350 } else { /* false */
351 /* We need to disable the netconsole before cleaning it up
352 * otherwise we might end up in write_msg() with
353 * nt->np.dev == NULL and nt->enabled == true
354 */
355 spin_lock_irqsave(&target_list_lock, flags);
356 nt->enabled = false;
357 spin_unlock_irqrestore(&target_list_lock, flags);
358 netpoll_cleanup(&nt->np);
359 }
360
361 nt->enabled = enabled;
362
363 mutex_unlock(&dynamic_netconsole_mutex);
364 return strnlen(buf, count);
365 out_unlock:
366 mutex_unlock(&dynamic_netconsole_mutex);
367 return err;
368 }
369
extended_store(struct config_item * item,const char * buf,size_t count)370 static ssize_t extended_store(struct config_item *item, const char *buf,
371 size_t count)
372 {
373 struct netconsole_target *nt = to_target(item);
374 int extended;
375 int err;
376
377 mutex_lock(&dynamic_netconsole_mutex);
378 if (nt->enabled) {
379 pr_err("target (%s) is enabled, disable to update parameters\n",
380 config_item_name(&nt->item));
381 err = -EINVAL;
382 goto out_unlock;
383 }
384
385 err = kstrtoint(buf, 10, &extended);
386 if (err < 0)
387 goto out_unlock;
388 if (extended < 0 || extended > 1) {
389 err = -EINVAL;
390 goto out_unlock;
391 }
392
393 nt->extended = extended;
394
395 mutex_unlock(&dynamic_netconsole_mutex);
396 return strnlen(buf, count);
397 out_unlock:
398 mutex_unlock(&dynamic_netconsole_mutex);
399 return err;
400 }
401
dev_name_store(struct config_item * item,const char * buf,size_t count)402 static ssize_t dev_name_store(struct config_item *item, const char *buf,
403 size_t count)
404 {
405 struct netconsole_target *nt = to_target(item);
406 size_t len;
407
408 mutex_lock(&dynamic_netconsole_mutex);
409 if (nt->enabled) {
410 pr_err("target (%s) is enabled, disable to update parameters\n",
411 config_item_name(&nt->item));
412 mutex_unlock(&dynamic_netconsole_mutex);
413 return -EINVAL;
414 }
415
416 strlcpy(nt->np.dev_name, buf, IFNAMSIZ);
417
418 /* Get rid of possible trailing newline from echo(1) */
419 len = strnlen(nt->np.dev_name, IFNAMSIZ);
420 if (nt->np.dev_name[len - 1] == '\n')
421 nt->np.dev_name[len - 1] = '\0';
422
423 mutex_unlock(&dynamic_netconsole_mutex);
424 return strnlen(buf, count);
425 }
426
local_port_store(struct config_item * item,const char * buf,size_t count)427 static ssize_t local_port_store(struct config_item *item, const char *buf,
428 size_t count)
429 {
430 struct netconsole_target *nt = to_target(item);
431 int rv = -EINVAL;
432
433 mutex_lock(&dynamic_netconsole_mutex);
434 if (nt->enabled) {
435 pr_err("target (%s) is enabled, disable to update parameters\n",
436 config_item_name(&nt->item));
437 goto out_unlock;
438 }
439
440 rv = kstrtou16(buf, 10, &nt->np.local_port);
441 if (rv < 0)
442 goto out_unlock;
443 mutex_unlock(&dynamic_netconsole_mutex);
444 return strnlen(buf, count);
445 out_unlock:
446 mutex_unlock(&dynamic_netconsole_mutex);
447 return rv;
448 }
449
remote_port_store(struct config_item * item,const char * buf,size_t count)450 static ssize_t remote_port_store(struct config_item *item,
451 const char *buf, size_t count)
452 {
453 struct netconsole_target *nt = to_target(item);
454 int rv = -EINVAL;
455
456 mutex_lock(&dynamic_netconsole_mutex);
457 if (nt->enabled) {
458 pr_err("target (%s) is enabled, disable to update parameters\n",
459 config_item_name(&nt->item));
460 goto out_unlock;
461 }
462
463 rv = kstrtou16(buf, 10, &nt->np.remote_port);
464 if (rv < 0)
465 goto out_unlock;
466 mutex_unlock(&dynamic_netconsole_mutex);
467 return strnlen(buf, count);
468 out_unlock:
469 mutex_unlock(&dynamic_netconsole_mutex);
470 return rv;
471 }
472
local_ip_store(struct config_item * item,const char * buf,size_t count)473 static ssize_t local_ip_store(struct config_item *item, const char *buf,
474 size_t count)
475 {
476 struct netconsole_target *nt = to_target(item);
477
478 mutex_lock(&dynamic_netconsole_mutex);
479 if (nt->enabled) {
480 pr_err("target (%s) is enabled, disable to update parameters\n",
481 config_item_name(&nt->item));
482 goto out_unlock;
483 }
484
485 if (strnchr(buf, count, ':')) {
486 const char *end;
487 if (in6_pton(buf, count, nt->np.local_ip.in6.s6_addr, -1, &end) > 0) {
488 if (*end && *end != '\n') {
489 pr_err("invalid IPv6 address at: <%c>\n", *end);
490 goto out_unlock;
491 }
492 nt->np.ipv6 = true;
493 } else
494 goto out_unlock;
495 } else {
496 if (!nt->np.ipv6) {
497 nt->np.local_ip.ip = in_aton(buf);
498 } else
499 goto out_unlock;
500 }
501
502 mutex_unlock(&dynamic_netconsole_mutex);
503 return strnlen(buf, count);
504 out_unlock:
505 mutex_unlock(&dynamic_netconsole_mutex);
506 return -EINVAL;
507 }
508
remote_ip_store(struct config_item * item,const char * buf,size_t count)509 static ssize_t remote_ip_store(struct config_item *item, const char *buf,
510 size_t count)
511 {
512 struct netconsole_target *nt = to_target(item);
513
514 mutex_lock(&dynamic_netconsole_mutex);
515 if (nt->enabled) {
516 pr_err("target (%s) is enabled, disable to update parameters\n",
517 config_item_name(&nt->item));
518 goto out_unlock;
519 }
520
521 if (strnchr(buf, count, ':')) {
522 const char *end;
523 if (in6_pton(buf, count, nt->np.remote_ip.in6.s6_addr, -1, &end) > 0) {
524 if (*end && *end != '\n') {
525 pr_err("invalid IPv6 address at: <%c>\n", *end);
526 goto out_unlock;
527 }
528 nt->np.ipv6 = true;
529 } else
530 goto out_unlock;
531 } else {
532 if (!nt->np.ipv6) {
533 nt->np.remote_ip.ip = in_aton(buf);
534 } else
535 goto out_unlock;
536 }
537
538 mutex_unlock(&dynamic_netconsole_mutex);
539 return strnlen(buf, count);
540 out_unlock:
541 mutex_unlock(&dynamic_netconsole_mutex);
542 return -EINVAL;
543 }
544
remote_mac_store(struct config_item * item,const char * buf,size_t count)545 static ssize_t remote_mac_store(struct config_item *item, const char *buf,
546 size_t count)
547 {
548 struct netconsole_target *nt = to_target(item);
549 u8 remote_mac[ETH_ALEN];
550
551 mutex_lock(&dynamic_netconsole_mutex);
552 if (nt->enabled) {
553 pr_err("target (%s) is enabled, disable to update parameters\n",
554 config_item_name(&nt->item));
555 goto out_unlock;
556 }
557
558 if (!mac_pton(buf, remote_mac))
559 goto out_unlock;
560 if (buf[3 * ETH_ALEN - 1] && buf[3 * ETH_ALEN - 1] != '\n')
561 goto out_unlock;
562 memcpy(nt->np.remote_mac, remote_mac, ETH_ALEN);
563
564 mutex_unlock(&dynamic_netconsole_mutex);
565 return strnlen(buf, count);
566 out_unlock:
567 mutex_unlock(&dynamic_netconsole_mutex);
568 return -EINVAL;
569 }
570
571 CONFIGFS_ATTR(, enabled);
572 CONFIGFS_ATTR(, extended);
573 CONFIGFS_ATTR(, dev_name);
574 CONFIGFS_ATTR(, local_port);
575 CONFIGFS_ATTR(, remote_port);
576 CONFIGFS_ATTR(, local_ip);
577 CONFIGFS_ATTR(, remote_ip);
578 CONFIGFS_ATTR_RO(, local_mac);
579 CONFIGFS_ATTR(, remote_mac);
580
581 static struct configfs_attribute *netconsole_target_attrs[] = {
582 &attr_enabled,
583 &attr_extended,
584 &attr_dev_name,
585 &attr_local_port,
586 &attr_remote_port,
587 &attr_local_ip,
588 &attr_remote_ip,
589 &attr_local_mac,
590 &attr_remote_mac,
591 NULL,
592 };
593
594 /*
595 * Item operations and type for netconsole_target.
596 */
597
netconsole_target_release(struct config_item * item)598 static void netconsole_target_release(struct config_item *item)
599 {
600 kfree(to_target(item));
601 }
602
603 static struct configfs_item_operations netconsole_target_item_ops = {
604 .release = netconsole_target_release,
605 };
606
607 static const struct config_item_type netconsole_target_type = {
608 .ct_attrs = netconsole_target_attrs,
609 .ct_item_ops = &netconsole_target_item_ops,
610 .ct_owner = THIS_MODULE,
611 };
612
613 /*
614 * Group operations and type for netconsole_subsys.
615 */
616
make_netconsole_target(struct config_group * group,const char * name)617 static struct config_item *make_netconsole_target(struct config_group *group,
618 const char *name)
619 {
620 unsigned long flags;
621 struct netconsole_target *nt;
622
623 /*
624 * Allocate and initialize with defaults.
625 * Target is disabled at creation (!enabled).
626 */
627 nt = kzalloc(sizeof(*nt), GFP_KERNEL);
628 if (!nt)
629 return ERR_PTR(-ENOMEM);
630
631 nt->np.name = "netconsole";
632 strlcpy(nt->np.dev_name, "eth0", IFNAMSIZ);
633 nt->np.local_port = 6665;
634 nt->np.remote_port = 6666;
635 eth_broadcast_addr(nt->np.remote_mac);
636
637 /* Initialize the config_item member */
638 config_item_init_type_name(&nt->item, name, &netconsole_target_type);
639
640 /* Adding, but it is disabled */
641 spin_lock_irqsave(&target_list_lock, flags);
642 list_add(&nt->list, &target_list);
643 spin_unlock_irqrestore(&target_list_lock, flags);
644
645 return &nt->item;
646 }
647
drop_netconsole_target(struct config_group * group,struct config_item * item)648 static void drop_netconsole_target(struct config_group *group,
649 struct config_item *item)
650 {
651 unsigned long flags;
652 struct netconsole_target *nt = to_target(item);
653
654 spin_lock_irqsave(&target_list_lock, flags);
655 list_del(&nt->list);
656 spin_unlock_irqrestore(&target_list_lock, flags);
657
658 /*
659 * The target may have never been enabled, or was manually disabled
660 * before being removed so netpoll may have already been cleaned up.
661 */
662 if (nt->enabled)
663 netpoll_cleanup(&nt->np);
664
665 config_item_put(&nt->item);
666 }
667
668 static struct configfs_group_operations netconsole_subsys_group_ops = {
669 .make_item = make_netconsole_target,
670 .drop_item = drop_netconsole_target,
671 };
672
673 static const struct config_item_type netconsole_subsys_type = {
674 .ct_group_ops = &netconsole_subsys_group_ops,
675 .ct_owner = THIS_MODULE,
676 };
677
678 /* The netconsole configfs subsystem */
679 static struct configfs_subsystem netconsole_subsys = {
680 .su_group = {
681 .cg_item = {
682 .ci_namebuf = "netconsole",
683 .ci_type = &netconsole_subsys_type,
684 },
685 },
686 };
687
688 #endif /* CONFIG_NETCONSOLE_DYNAMIC */
689
690 /* Handle network interface device notifications */
netconsole_netdev_event(struct notifier_block * this,unsigned long event,void * ptr)691 static int netconsole_netdev_event(struct notifier_block *this,
692 unsigned long event, void *ptr)
693 {
694 unsigned long flags;
695 struct netconsole_target *nt;
696 struct net_device *dev = netdev_notifier_info_to_dev(ptr);
697 bool stopped = false;
698
699 if (!(event == NETDEV_CHANGENAME || event == NETDEV_UNREGISTER ||
700 event == NETDEV_RELEASE || event == NETDEV_JOIN))
701 goto done;
702
703 spin_lock_irqsave(&target_list_lock, flags);
704 restart:
705 list_for_each_entry(nt, &target_list, list) {
706 netconsole_target_get(nt);
707 if (nt->np.dev == dev) {
708 switch (event) {
709 case NETDEV_CHANGENAME:
710 strlcpy(nt->np.dev_name, dev->name, IFNAMSIZ);
711 break;
712 case NETDEV_RELEASE:
713 case NETDEV_JOIN:
714 case NETDEV_UNREGISTER:
715 /* rtnl_lock already held
716 * we might sleep in __netpoll_cleanup()
717 */
718 spin_unlock_irqrestore(&target_list_lock, flags);
719
720 __netpoll_cleanup(&nt->np);
721
722 spin_lock_irqsave(&target_list_lock, flags);
723 dev_put(nt->np.dev);
724 nt->np.dev = NULL;
725 nt->enabled = false;
726 stopped = true;
727 netconsole_target_put(nt);
728 goto restart;
729 }
730 }
731 netconsole_target_put(nt);
732 }
733 spin_unlock_irqrestore(&target_list_lock, flags);
734 if (stopped) {
735 const char *msg = "had an event";
736 switch (event) {
737 case NETDEV_UNREGISTER:
738 msg = "unregistered";
739 break;
740 case NETDEV_RELEASE:
741 msg = "released slaves";
742 break;
743 case NETDEV_JOIN:
744 msg = "is joining a master device";
745 break;
746 }
747 pr_info("network logging stopped on interface %s as it %s\n",
748 dev->name, msg);
749 }
750
751 done:
752 return NOTIFY_DONE;
753 }
754
755 static struct notifier_block netconsole_netdev_notifier = {
756 .notifier_call = netconsole_netdev_event,
757 };
758
759 /**
760 * send_ext_msg_udp - send extended log message to target
761 * @nt: target to send message to
762 * @msg: extended log message to send
763 * @msg_len: length of message
764 *
765 * Transfer extended log @msg to @nt. If @msg is longer than
766 * MAX_PRINT_CHUNK, it'll be split and transmitted in multiple chunks with
767 * ncfrag header field added to identify them.
768 */
send_ext_msg_udp(struct netconsole_target * nt,const char * msg,int msg_len)769 static void send_ext_msg_udp(struct netconsole_target *nt, const char *msg,
770 int msg_len)
771 {
772 static char buf[MAX_PRINT_CHUNK]; /* protected by target_list_lock */
773 const char *header, *body;
774 int offset = 0;
775 int header_len, body_len;
776
777 if (msg_len <= MAX_PRINT_CHUNK) {
778 netpoll_send_udp(&nt->np, msg, msg_len);
779 return;
780 }
781
782 /* need to insert extra header fields, detect header and body */
783 header = msg;
784 body = memchr(msg, ';', msg_len);
785 if (WARN_ON_ONCE(!body))
786 return;
787
788 header_len = body - header;
789 body_len = msg_len - header_len - 1;
790 body++;
791
792 /*
793 * Transfer multiple chunks with the following extra header.
794 * "ncfrag=<byte-offset>/<total-bytes>"
795 */
796 memcpy(buf, header, header_len);
797
798 while (offset < body_len) {
799 int this_header = header_len;
800 int this_chunk;
801
802 this_header += scnprintf(buf + this_header,
803 sizeof(buf) - this_header,
804 ",ncfrag=%d/%d;", offset, body_len);
805
806 this_chunk = min(body_len - offset,
807 MAX_PRINT_CHUNK - this_header);
808 if (WARN_ON_ONCE(this_chunk <= 0))
809 return;
810
811 memcpy(buf + this_header, body + offset, this_chunk);
812
813 netpoll_send_udp(&nt->np, buf, this_header + this_chunk);
814
815 offset += this_chunk;
816 }
817 }
818
write_ext_msg(struct console * con,const char * msg,unsigned int len)819 static void write_ext_msg(struct console *con, const char *msg,
820 unsigned int len)
821 {
822 struct netconsole_target *nt;
823 unsigned long flags;
824
825 if ((oops_only && !oops_in_progress) || list_empty(&target_list))
826 return;
827
828 spin_lock_irqsave(&target_list_lock, flags);
829 list_for_each_entry(nt, &target_list, list)
830 if (nt->extended && nt->enabled && netif_running(nt->np.dev))
831 send_ext_msg_udp(nt, msg, len);
832 spin_unlock_irqrestore(&target_list_lock, flags);
833 }
834
write_msg(struct console * con,const char * msg,unsigned int len)835 static void write_msg(struct console *con, const char *msg, unsigned int len)
836 {
837 int frag, left;
838 unsigned long flags;
839 struct netconsole_target *nt;
840 const char *tmp;
841
842 if (oops_only && !oops_in_progress)
843 return;
844 /* Avoid taking lock and disabling interrupts unnecessarily */
845 if (list_empty(&target_list))
846 return;
847
848 spin_lock_irqsave(&target_list_lock, flags);
849 list_for_each_entry(nt, &target_list, list) {
850 if (!nt->extended && nt->enabled && netif_running(nt->np.dev)) {
851 /*
852 * We nest this inside the for-each-target loop above
853 * so that we're able to get as much logging out to
854 * at least one target if we die inside here, instead
855 * of unnecessarily keeping all targets in lock-step.
856 */
857 tmp = msg;
858 for (left = len; left;) {
859 frag = min(left, MAX_PRINT_CHUNK);
860 netpoll_send_udp(&nt->np, tmp, frag);
861 tmp += frag;
862 left -= frag;
863 }
864 }
865 }
866 spin_unlock_irqrestore(&target_list_lock, flags);
867 }
868
869 static struct console netconsole_ext = {
870 .name = "netcon_ext",
871 .flags = CON_EXTENDED, /* starts disabled, registered on first use */
872 .write = write_ext_msg,
873 };
874
875 static struct console netconsole = {
876 .name = "netcon",
877 .flags = CON_ENABLED,
878 .write = write_msg,
879 };
880
init_netconsole(void)881 static int __init init_netconsole(void)
882 {
883 int err;
884 struct netconsole_target *nt, *tmp;
885 unsigned long flags;
886 char *target_config;
887 char *input = config;
888
889 if (strnlen(input, MAX_PARAM_LENGTH)) {
890 while ((target_config = strsep(&input, ";"))) {
891 nt = alloc_param_target(target_config);
892 if (IS_ERR(nt)) {
893 err = PTR_ERR(nt);
894 goto fail;
895 }
896 /* Dump existing printks when we register */
897 if (nt->extended)
898 netconsole_ext.flags |= CON_PRINTBUFFER |
899 CON_ENABLED;
900 else
901 netconsole.flags |= CON_PRINTBUFFER;
902
903 spin_lock_irqsave(&target_list_lock, flags);
904 list_add(&nt->list, &target_list);
905 spin_unlock_irqrestore(&target_list_lock, flags);
906 }
907 }
908
909 err = register_netdevice_notifier(&netconsole_netdev_notifier);
910 if (err)
911 goto fail;
912
913 err = dynamic_netconsole_init();
914 if (err)
915 goto undonotifier;
916
917 if (netconsole_ext.flags & CON_ENABLED)
918 register_console(&netconsole_ext);
919 register_console(&netconsole);
920 pr_info("network logging started\n");
921
922 return err;
923
924 undonotifier:
925 unregister_netdevice_notifier(&netconsole_netdev_notifier);
926
927 fail:
928 pr_err("cleaning up\n");
929
930 /*
931 * Remove all targets and destroy them (only targets created
932 * from the boot/module option exist here). Skipping the list
933 * lock is safe here, and netpoll_cleanup() will sleep.
934 */
935 list_for_each_entry_safe(nt, tmp, &target_list, list) {
936 list_del(&nt->list);
937 free_param_target(nt);
938 }
939
940 return err;
941 }
942
cleanup_netconsole(void)943 static void __exit cleanup_netconsole(void)
944 {
945 struct netconsole_target *nt, *tmp;
946
947 unregister_console(&netconsole_ext);
948 unregister_console(&netconsole);
949 dynamic_netconsole_exit();
950 unregister_netdevice_notifier(&netconsole_netdev_notifier);
951
952 /*
953 * Targets created via configfs pin references on our module
954 * and would first be rmdir(2)'ed from userspace. We reach
955 * here only when they are already destroyed, and only those
956 * created from the boot/module option are left, so remove and
957 * destroy them. Skipping the list lock is safe here, and
958 * netpoll_cleanup() will sleep.
959 */
960 list_for_each_entry_safe(nt, tmp, &target_list, list) {
961 list_del(&nt->list);
962 free_param_target(nt);
963 }
964 }
965
966 /*
967 * Use late_initcall to ensure netconsole is
968 * initialized after network device driver if built-in.
969 *
970 * late_initcall() and module_init() are identical if built as module.
971 */
972 late_initcall(init_netconsole);
973 module_exit(cleanup_netconsole);
974