xref: /freebsd/sys/dev/wtap/plugins/visibility.c (revision fb1749cc6468220a69a8fdc7a2d0aac51ada598a)
104d19802SAdrian Chadd /*-
24d846d26SWarner Losh  * SPDX-License-Identifier: BSD-2-Clause
3718cf2ccSPedro F. Giffuni  *
404d19802SAdrian Chadd  * Copyright (c) 2010-2011 Monthadar Al Jaberi, TerraNet AB
504d19802SAdrian Chadd  * All rights reserved.
604d19802SAdrian Chadd  *
704d19802SAdrian Chadd  * Redistribution and use in source and binary forms, with or without
804d19802SAdrian Chadd  * modification, are permitted provided that the following conditions
904d19802SAdrian Chadd  * are met:
1004d19802SAdrian Chadd  * 1. Redistributions of source code must retain the above copyright
1104d19802SAdrian Chadd  *    notice, this list of conditions and the following disclaimer,
1204d19802SAdrian Chadd  *    without modification.
1304d19802SAdrian Chadd  * 2. Redistributions in binary form must reproduce at minimum a disclaimer
1404d19802SAdrian Chadd  *    similar to the "NO WARRANTY" disclaimer below ("Disclaimer") and any
1504d19802SAdrian Chadd  *    redistribution must be conditioned upon including a substantially
1604d19802SAdrian Chadd  *    similar Disclaimer requirement for further binary redistribution.
1704d19802SAdrian Chadd  *
1804d19802SAdrian Chadd  * NO WARRANTY
1904d19802SAdrian Chadd  * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
2004d19802SAdrian Chadd  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
2104d19802SAdrian Chadd  * LIMITED TO, THE IMPLIED WARRANTIES OF NONINFRINGEMENT, MERCHANTIBILITY
2204d19802SAdrian Chadd  * AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL
2304d19802SAdrian Chadd  * THE COPYRIGHT HOLDERS OR CONTRIBUTORS BE LIABLE FOR SPECIAL, EXEMPLARY,
2404d19802SAdrian Chadd  * OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
2504d19802SAdrian Chadd  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
2604d19802SAdrian Chadd  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER
2704d19802SAdrian Chadd  * IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
2804d19802SAdrian Chadd  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF
2904d19802SAdrian Chadd  * THE POSSIBILITY OF SUCH DAMAGES.
3004d19802SAdrian Chadd  */
31*fb1749ccSLi-Wen Hsu 
3204d19802SAdrian Chadd #include <sys/param.h>
3304d19802SAdrian Chadd #include <sys/jail.h>
3404d19802SAdrian Chadd 
3504d19802SAdrian Chadd #include <sys/socket.h>
3604d19802SAdrian Chadd 
3704d19802SAdrian Chadd #include <net/if.h>
3804d19802SAdrian Chadd #include <netinet/in.h>
3904d19802SAdrian Chadd 
4004d19802SAdrian Chadd #include "visibility.h"
4104d19802SAdrian Chadd 
4204d19802SAdrian Chadd /* Function prototypes */
4304d19802SAdrian Chadd static d_ioctl_t	vis_ioctl;
4404d19802SAdrian Chadd 
4504d19802SAdrian Chadd static struct cdevsw vis_cdevsw = {
4604d19802SAdrian Chadd 	.d_version =	D_VERSION,
4704d19802SAdrian Chadd 	.d_flags =	0,
4804d19802SAdrian Chadd 	.d_ioctl =	vis_ioctl,
4904d19802SAdrian Chadd 	.d_name =	"visctl",
5004d19802SAdrian Chadd };
5104d19802SAdrian Chadd 
5204d19802SAdrian Chadd void
visibility_init(struct wtap_plugin * plugin)5304d19802SAdrian Chadd visibility_init(struct wtap_plugin *plugin)
5404d19802SAdrian Chadd {
5504d19802SAdrian Chadd 	struct visibility_plugin *vis_plugin;
5604d19802SAdrian Chadd 
5704d19802SAdrian Chadd 	vis_plugin = (struct visibility_plugin *) plugin;
5804d19802SAdrian Chadd 	plugin->wp_sdev = make_dev(&vis_cdevsw,0,UID_ROOT,GID_WHEEL,0600,
5904d19802SAdrian Chadd 	    (const char *)"visctl");
6004d19802SAdrian Chadd 	plugin->wp_sdev->si_drv1 = vis_plugin;
6104d19802SAdrian Chadd 	mtx_init(&vis_plugin->pl_mtx, "visibility_plugin mtx",
6204d19802SAdrian Chadd 	    NULL, MTX_DEF | MTX_RECURSE);
6304d19802SAdrian Chadd 	printf("Using visibility wtap plugin...\n");
6404d19802SAdrian Chadd }
6504d19802SAdrian Chadd 
6604d19802SAdrian Chadd void
visibility_deinit(struct wtap_plugin * plugin)6704d19802SAdrian Chadd visibility_deinit(struct wtap_plugin *plugin)
6804d19802SAdrian Chadd {
6904d19802SAdrian Chadd 	struct visibility_plugin *vis_plugin;
7004d19802SAdrian Chadd 
7104d19802SAdrian Chadd 	vis_plugin = (struct visibility_plugin *) plugin;
7204d19802SAdrian Chadd 	destroy_dev(plugin->wp_sdev);
7304d19802SAdrian Chadd 	mtx_destroy(&vis_plugin->pl_mtx);
7404d19802SAdrian Chadd 	free(vis_plugin, M_WTAP_PLUGIN);
7504d19802SAdrian Chadd 	printf("Removing visibility wtap plugin...\n");
7604d19802SAdrian Chadd }
7704d19802SAdrian Chadd 
7804d19802SAdrian Chadd /* We need to use a mutex lock when we read out a visibility map
7904d19802SAdrian Chadd  * and when we change visibility map from user space through IOCTL
8004d19802SAdrian Chadd  */
8104d19802SAdrian Chadd void
visibility_work(struct wtap_plugin * plugin,struct packet * p)8204d19802SAdrian Chadd visibility_work(struct wtap_plugin *plugin, struct packet *p)
8304d19802SAdrian Chadd {
8404d19802SAdrian Chadd 	struct visibility_plugin *vis_plugin =
8504d19802SAdrian Chadd 	    (struct visibility_plugin *) plugin;
8604d19802SAdrian Chadd 	struct wtap_hal *hal = (struct wtap_hal *)vis_plugin->base.wp_hal;
8704d19802SAdrian Chadd 	struct vis_map *map;
8804d19802SAdrian Chadd 
8904d19802SAdrian Chadd 	KASSERT(mtod(p->m, const char *) != (const char *) 0xdeadc0de ||
9004d19802SAdrian Chadd 	    mtod(p->m, const char *) != NULL,
9104d19802SAdrian Chadd 	    ("[%s] got a corrupt packet from master queue, p->m=%p, p->id=%d\n",
9204d19802SAdrian Chadd 	    __func__, p->m, p->id));
9304d19802SAdrian Chadd 	DWTAP_PRINTF("[%d] BROADCASTING m=%p\n", p->id, p->m);
9404d19802SAdrian Chadd 	mtx_lock(&vis_plugin->pl_mtx);
9504d19802SAdrian Chadd 	map = &vis_plugin->pl_node[p->id];
9604d19802SAdrian Chadd 	mtx_unlock(&vis_plugin->pl_mtx);
9704d19802SAdrian Chadd 
9804d19802SAdrian Chadd 	/* This is O(n*n) which is not optimal for large
9904d19802SAdrian Chadd 	 * number of nodes. Another way of doing it is
10004d19802SAdrian Chadd 	 * creating groups of nodes that hear each other.
10104d19802SAdrian Chadd 	 * Atleast for this simple static node plugin.
10204d19802SAdrian Chadd 	 */
10304d19802SAdrian Chadd 	for(int i=0; i<ARRAY_SIZE; ++i){
10404d19802SAdrian Chadd 		uint32_t index = map->map[i];
10504d19802SAdrian Chadd 		for(int j=0; j<32; ++j){
10604d19802SAdrian Chadd 			int vis = index & 0x01;
10704d19802SAdrian Chadd 			if(vis){
10804d19802SAdrian Chadd 				int k = i*ARRAY_SIZE + j;
10904d19802SAdrian Chadd 				if(hal->hal_devs[k] != NULL
11004d19802SAdrian Chadd 				    && hal->hal_devs[k]->up == 1){
11104d19802SAdrian Chadd 					struct wtap_softc *sc =
11204d19802SAdrian Chadd 					    hal->hal_devs[k];
11304d19802SAdrian Chadd 					struct mbuf *m =
114c6499eccSGleb Smirnoff 					    m_dup(p->m, M_NOWAIT);
11504d19802SAdrian Chadd 					DWTAP_PRINTF("[%d] duplicated old_m=%p"
11604d19802SAdrian Chadd 					    "to new_m=%p\n", p->id, p->m, m);
11704d19802SAdrian Chadd #if 0
11804d19802SAdrian Chadd 					printf("[%d] sending to %d\n",
11904d19802SAdrian Chadd 					    p->id, k);
12004d19802SAdrian Chadd #endif
12104d19802SAdrian Chadd 					wtap_inject(sc, m);
12204d19802SAdrian Chadd 				}
12304d19802SAdrian Chadd 			}
12404d19802SAdrian Chadd 			index = index >> 1;
12504d19802SAdrian Chadd 		}
12604d19802SAdrian Chadd 	}
12704d19802SAdrian Chadd }
12804d19802SAdrian Chadd 
12904d19802SAdrian Chadd static void
add_link(struct visibility_plugin * vis_plugin,struct link * l)13004d19802SAdrian Chadd add_link(struct visibility_plugin *vis_plugin, struct link *l)
13104d19802SAdrian Chadd {
13204d19802SAdrian Chadd 
13304d19802SAdrian Chadd 	mtx_lock(&vis_plugin->pl_mtx);
13404d19802SAdrian Chadd 	struct vis_map *map = &vis_plugin->pl_node[l->id1];
13504d19802SAdrian Chadd 	int index = l->id2/ARRAY_SIZE;
13604d19802SAdrian Chadd 	int bit = l->id2 % ARRAY_SIZE;
13704d19802SAdrian Chadd 	uint32_t value = 1 << bit;
13804d19802SAdrian Chadd 	map->map[index] = map->map[index] | value;
13904d19802SAdrian Chadd 	mtx_unlock(&vis_plugin->pl_mtx);
14004d19802SAdrian Chadd #if 0
14104d19802SAdrian Chadd 	printf("l->id1=%d, l->id2=%d, map->map[%d] = %u, bit=%d\n",
14204d19802SAdrian Chadd 	    l->id1, l->id2, index, map->map[index], bit);
14304d19802SAdrian Chadd #endif
14404d19802SAdrian Chadd }
14504d19802SAdrian Chadd 
14604d19802SAdrian Chadd static void
del_link(struct visibility_plugin * vis_plugin,struct link * l)14704d19802SAdrian Chadd del_link(struct visibility_plugin *vis_plugin, struct link *l)
14804d19802SAdrian Chadd {
14904d19802SAdrian Chadd 
15004d19802SAdrian Chadd 	mtx_lock(&vis_plugin->pl_mtx);
15104d19802SAdrian Chadd 	struct vis_map *map = &vis_plugin->pl_node[l->id1];
15204d19802SAdrian Chadd 	int index = l->id2/ARRAY_SIZE;
15304d19802SAdrian Chadd 	int bit = l->id2 % ARRAY_SIZE;
15404d19802SAdrian Chadd 	uint32_t value = 1 << bit;
15504d19802SAdrian Chadd 	map->map[index] = map->map[index] & ~value;
15604d19802SAdrian Chadd 	mtx_unlock(&vis_plugin->pl_mtx);
15704d19802SAdrian Chadd #if 0
15804d19802SAdrian Chadd 	printf("map->map[index] = %u\n", map->map[index]);
15904d19802SAdrian Chadd #endif
16004d19802SAdrian Chadd }
16104d19802SAdrian Chadd 
16204d19802SAdrian Chadd int
vis_ioctl(struct cdev * sdev,u_long cmd,caddr_t data,int fflag,struct thread * td)16304d19802SAdrian Chadd vis_ioctl(struct cdev *sdev, u_long cmd, caddr_t data,
16404d19802SAdrian Chadd     int fflag, struct thread *td)
16504d19802SAdrian Chadd {
16604d19802SAdrian Chadd 	struct visibility_plugin *vis_plugin =
16704d19802SAdrian Chadd 	    (struct visibility_plugin *) sdev->si_drv1;
16804d19802SAdrian Chadd 	struct wtap_hal *hal = vis_plugin->base.wp_hal;
16904d19802SAdrian Chadd 	struct link l;
17004d19802SAdrian Chadd 	int op;
17104d19802SAdrian Chadd 	int error = 0;
17204d19802SAdrian Chadd 
17304d19802SAdrian Chadd 	CURVNET_SET(CRED_TO_VNET(curthread->td_ucred));
17404d19802SAdrian Chadd 	switch(cmd) {
17504d19802SAdrian Chadd 	case VISIOCTLOPEN:
17604d19802SAdrian Chadd 		op =  *(int *)data;
17704d19802SAdrian Chadd 		if(op == 0)
17804d19802SAdrian Chadd 			medium_close(hal->hal_md);
17904d19802SAdrian Chadd 		else
18004d19802SAdrian Chadd 			medium_open(hal->hal_md);
18104d19802SAdrian Chadd 		break;
18204d19802SAdrian Chadd 	case VISIOCTLLINK:
18304d19802SAdrian Chadd 		l = *(struct link *)data;
18404d19802SAdrian Chadd 		if(l.op == 0)
18504d19802SAdrian Chadd 			del_link(vis_plugin, &l);
18604d19802SAdrian Chadd 		else
18704d19802SAdrian Chadd 			add_link(vis_plugin, &l);
18804d19802SAdrian Chadd #if 0
18904d19802SAdrian Chadd 		printf("op=%d, id1=%d, id2=%d\n", l.op, l.id1, l.id2);
19004d19802SAdrian Chadd #endif
19104d19802SAdrian Chadd 		break;
19204d19802SAdrian Chadd 	default:
193b790c193SPedro F. Giffuni 		DWTAP_PRINTF("Unknown WTAP IOCTL\n");
19404d19802SAdrian Chadd 		error = EINVAL;
19504d19802SAdrian Chadd 	}
19604d19802SAdrian Chadd 
19704d19802SAdrian Chadd 	CURVNET_RESTORE();
19804d19802SAdrian Chadd 	return error;
19904d19802SAdrian Chadd }
200