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