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