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