Add sources for my original BeOS BONE tun/tap config driver
as a starting point. Change-Id: I9c3b1027a7fda4ab1eaced486eb2455a19571fee
This commit is contained in:
François Revol
Alexander von Gluck IV
parent
b5d2337330
commit
b110fce124
64
headers/posix/net/if_tun.h
Normal file
64
headers/posix/net/if_tun.h
Normal file
@ -0,0 +1,64 @@
|
|||||||
|
/*
|
||||||
|
* Copyright 2003-2018 Haiku, Inc. All Rights Reserved.
|
||||||
|
* Distributed under the terms of the MIT License.
|
||||||
|
*/
|
||||||
|
|
||||||
|
#ifndef _NET_IF_TUN_H
|
||||||
|
#define _NET_IF_TUN_H
|
||||||
|
|
||||||
|
#include <sys/sockio.h>
|
||||||
|
|
||||||
|
/*
|
||||||
|
* public API for tun/tap device.
|
||||||
|
* This API is compatible with the Linux tun/tap driver from
|
||||||
|
* http://vtun.sourceforge.net/tun/index.html
|
||||||
|
*/
|
||||||
|
|
||||||
|
|
||||||
|
/* max of each type */
|
||||||
|
#define TUN_MAX_DEV 10
|
||||||
|
/*255*/
|
||||||
|
|
||||||
|
/* TX queue size */
|
||||||
|
#define TUN_TXQ_SIZE 10
|
||||||
|
|
||||||
|
/* Max frame size */
|
||||||
|
#define TUN_MAX_FRAME 4096
|
||||||
|
|
||||||
|
/* TUN device flags */
|
||||||
|
#define TUN_TUN_DEV 0x0001
|
||||||
|
#define TUN_TAP_DEV 0x0002
|
||||||
|
#define TUN_TYPE_MASK 0x000f
|
||||||
|
|
||||||
|
/* not yet*//*#define TUN_FASYNC 0x0010*/
|
||||||
|
#define TUN_NOCHECKSUM 0x0020
|
||||||
|
#define TUN_NO_PI 0x0040
|
||||||
|
|
||||||
|
#define TUN_IFF_SET 0x1000
|
||||||
|
|
||||||
|
/* Ioctl defines */
|
||||||
|
/* XXX: NOT OFFICIAL */
|
||||||
|
#define TUNSETNOCSUM (B_DEVICE_OP_CODES_END+0x90)
|
||||||
|
#define TUNSETDEBUG (B_DEVICE_OP_CODES_END+0x91)
|
||||||
|
#define TUNSETIFF (B_DEVICE_OP_CODES_END+0x92)
|
||||||
|
|
||||||
|
/* get/set MAC address */
|
||||||
|
//#define SIOCGIFHWADDR (BONE_SOCKIO_IOCTL_BASE+0x95)
|
||||||
|
//#define SIOCSIFHWADDR (BONE_SOCKIO_IOCTL_BASE+0x96)
|
||||||
|
|
||||||
|
/* TUNSETIFF ifr flags */
|
||||||
|
#define IFF_TUN 0x0001
|
||||||
|
#define IFF_TAP 0x0002
|
||||||
|
#define IFF_NO_PI 0x1000
|
||||||
|
/* XXX: fix the confusion about which *NO_PI go where ! */
|
||||||
|
|
||||||
|
struct tun_pi {
|
||||||
|
unsigned short flags;
|
||||||
|
unsigned short proto;
|
||||||
|
};
|
||||||
|
/* tun_pi::flags */
|
||||||
|
#define TUN_PKT_STRIP 0x0001
|
||||||
|
|
||||||
|
#define TUN_DEVICE "/dev/config/tun"
|
||||||
|
|
||||||
|
#endif /* __IF_TUN_H */
|
||||||
12
src/add-ons/kernel/drivers/network/tun/Jamfile
Normal file
12
src/add-ons/kernel/drivers/network/tun/Jamfile
Normal file
@ -0,0 +1,12 @@
|
|||||||
|
SubDir HAIKU_TOP src add-ons kernel drivers network tun ;
|
||||||
|
|
||||||
|
UsePrivateSystemHeaders ;
|
||||||
|
# For net_tun.h
|
||||||
|
UsePrivateHeaders net ;
|
||||||
|
|
||||||
|
KernelAddon tun_config :
|
||||||
|
driver.c
|
||||||
|
;
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
335
src/add-ons/kernel/drivers/network/tun/driver.c
Normal file
335
src/add-ons/kernel/drivers/network/tun/driver.c
Normal file
@ -0,0 +1,335 @@
|
|||||||
|
#include <Drivers.h>
|
||||||
|
#include <KernelExport.h>
|
||||||
|
#include <OS.h>
|
||||||
|
#include <stdlib.h>
|
||||||
|
#include <string.h>
|
||||||
|
#include <sys/param.h>
|
||||||
|
#include <sys/types.h>
|
||||||
|
#include <unistd.h>
|
||||||
|
#include <fcntl.h>
|
||||||
|
#include <fsproto.h>
|
||||||
|
#include "bone_tun.h"
|
||||||
|
|
||||||
|
/*
|
||||||
|
* /dev/config/tun network tunnel driver for BeOS
|
||||||
|
* (c) 2003, mmu_man, revol@free.fr
|
||||||
|
* licenced under MIT licence.
|
||||||
|
*/
|
||||||
|
|
||||||
|
|
||||||
|
const char * device_names[]={TUN_DRIVER_NAME, NULL};
|
||||||
|
extern device_hooks tun_hooks;
|
||||||
|
|
||||||
|
int32 api_version = B_CUR_DRIVER_API_VERSION;
|
||||||
|
|
||||||
|
vint32 if_mod_ref_count = 0;
|
||||||
|
bone_tun_interface_info_t *gIfaceModule = NULL;
|
||||||
|
bone_util_info_t *gUtil = NULL;
|
||||||
|
|
||||||
|
status_t init_hardware(void) {
|
||||||
|
dprintf("tun:init_hardware()\n");
|
||||||
|
return B_OK;
|
||||||
|
}
|
||||||
|
|
||||||
|
status_t init_driver(void) {
|
||||||
|
dprintf("tun:init_driver()\n");
|
||||||
|
return B_OK;
|
||||||
|
}
|
||||||
|
|
||||||
|
void uninit_driver(void) {
|
||||||
|
dprintf("tun:uninit_driver()\n");
|
||||||
|
}
|
||||||
|
|
||||||
|
const char **publish_devices() {
|
||||||
|
return device_names;
|
||||||
|
}
|
||||||
|
|
||||||
|
device_hooks *find_device(const char *name) {
|
||||||
|
(void)name;
|
||||||
|
return &tun_hooks;
|
||||||
|
}
|
||||||
|
|
||||||
|
status_t tun_open(const char *name, uint32 flags, cookie_t **cookie) {
|
||||||
|
status_t err = B_OK;
|
||||||
|
(void)name; (void)flags;
|
||||||
|
/* XXX: add O_NONBLOCK + FIONBIO */
|
||||||
|
#if DEBUG > 1
|
||||||
|
dprintf("tun:open(%s, 0x%08lx,)\n", name, flags);
|
||||||
|
#endif
|
||||||
|
err = get_module(BONE_UTIL_MOD_NAME, (struct module_info **)&gUtil);
|
||||||
|
if (err < B_OK)
|
||||||
|
return err;
|
||||||
|
err = get_module(TUN_INTERFACE_MODULE, (struct module_info **)&gIfaceModule);
|
||||||
|
if (err < B_OK) {
|
||||||
|
put_module(BONE_UTIL_MOD_NAME);
|
||||||
|
return err;
|
||||||
|
}
|
||||||
|
|
||||||
|
/* XXX: FIXME, still not ok (rescan) */
|
||||||
|
if (atomic_add(&if_mod_ref_count, 1) < 1) /* force one more open to keep loaded */
|
||||||
|
get_module(TUN_INTERFACE_MODULE, (struct module_info **)&gIfaceModule);
|
||||||
|
|
||||||
|
*cookie = (void*)malloc(sizeof(cookie_t));
|
||||||
|
if (*cookie == NULL) {
|
||||||
|
dprintf("tun_open : error allocating cookie\n");
|
||||||
|
goto err0;
|
||||||
|
}
|
||||||
|
memset(*cookie, 0, sizeof(cookie_t));
|
||||||
|
(*cookie)->blocking_io = true;
|
||||||
|
return B_OK;
|
||||||
|
|
||||||
|
err1:
|
||||||
|
dprintf("tun_open : cleanup : will free cookie\n");
|
||||||
|
free(*cookie);
|
||||||
|
*cookie = NULL;
|
||||||
|
put_module(TUN_INTERFACE_MODULE);
|
||||||
|
put_module(BONE_UTIL_MOD_NAME);
|
||||||
|
err0:
|
||||||
|
return B_ERROR;
|
||||||
|
}
|
||||||
|
|
||||||
|
status_t tun_close(void *cookie) {
|
||||||
|
(void)cookie;
|
||||||
|
return B_OK;
|
||||||
|
}
|
||||||
|
|
||||||
|
status_t tun_free(cookie_t *cookie) {
|
||||||
|
status_t err = B_OK;
|
||||||
|
#if DEBUG > 1
|
||||||
|
dprintf("tun_close()\n");
|
||||||
|
#endif
|
||||||
|
if (cookie->iface)
|
||||||
|
err = gIfaceModule->tun_detach_driver(cookie->iface, true);
|
||||||
|
free(cookie);
|
||||||
|
atomic_add(&if_mod_ref_count, -1);
|
||||||
|
put_module(TUN_INTERFACE_MODULE);
|
||||||
|
put_module(BONE_UTIL_MOD_NAME);
|
||||||
|
return err;
|
||||||
|
}
|
||||||
|
|
||||||
|
status_t tun_ioctl(cookie_t *cookie, uint32 op, void *data, size_t len) {
|
||||||
|
ifreq_t *ifr;
|
||||||
|
bone_tun_if_interface_t *iface;
|
||||||
|
(void)cookie; (void)op; (void)data; (void)len;
|
||||||
|
iface = cookie->iface;
|
||||||
|
#if DEBUG > 1
|
||||||
|
dprintf("tun_ioctl(%d(0x%08lx), , %d)\n", op, op, len);
|
||||||
|
#endif
|
||||||
|
|
||||||
|
switch (op) {
|
||||||
|
case B_SET_NONBLOCKING_IO:
|
||||||
|
cookie->blocking_io = false;
|
||||||
|
return B_OK;
|
||||||
|
case B_SET_BLOCKING_IO:
|
||||||
|
cookie->blocking_io = true;
|
||||||
|
return B_OK;
|
||||||
|
case TUNSETNOCSUM:
|
||||||
|
return B_OK;//EOPNOTSUPP;
|
||||||
|
case TUNSETDEBUG:
|
||||||
|
return B_OK;//EOPNOTSUPP;
|
||||||
|
case TUNSETIFF:
|
||||||
|
if (data == NULL)
|
||||||
|
return EINVAL;
|
||||||
|
ifr = (ifreq_t *)data;
|
||||||
|
|
||||||
|
iface = gIfaceModule->tun_reuse_or_create(ifr, cookie);
|
||||||
|
if (iface != NULL) {
|
||||||
|
dprintf("tun: new tunnel created: %s, flags: 0x%08lx\n", ifr->ifr_name, iface->flags);
|
||||||
|
return B_OK;
|
||||||
|
} else
|
||||||
|
dprintf("tun: can't allocate a new tunnel!\n");
|
||||||
|
break;
|
||||||
|
|
||||||
|
case SIOCGIFHWADDR:
|
||||||
|
if (data == NULL)
|
||||||
|
return EINVAL;
|
||||||
|
ifr = (ifreq_t *)data;
|
||||||
|
if (iface == NULL)
|
||||||
|
return EINVAL;
|
||||||
|
if (strncmp(ifr->ifr_name, iface->ifn->if_name, IFNAMSIZ) != 0)
|
||||||
|
return EINVAL;
|
||||||
|
memcpy(ifr->ifr_hwaddr, iface->fakemac.octet, 6);
|
||||||
|
return B_OK;
|
||||||
|
case SIOCSIFHWADDR:
|
||||||
|
if (data == NULL)
|
||||||
|
return EINVAL;
|
||||||
|
ifr = (ifreq_t *)data;
|
||||||
|
if (iface == NULL)
|
||||||
|
return EINVAL;
|
||||||
|
if (strncmp(ifr->ifr_name, iface->ifn->if_name, IFNAMSIZ) != 0)
|
||||||
|
return EINVAL;
|
||||||
|
memcpy(iface->fakemac.octet, ifr->ifr_hwaddr, 6);
|
||||||
|
return B_OK;
|
||||||
|
|
||||||
|
}
|
||||||
|
return B_ERROR;
|
||||||
|
}
|
||||||
|
|
||||||
|
status_t tun_read(cookie_t *cookie, off_t position, void *data, size_t *numbytes) {
|
||||||
|
bone_data_t *bdata;
|
||||||
|
uint32 got;
|
||||||
|
ssize_t pktsize;
|
||||||
|
if (cookie->iface == NULL)
|
||||||
|
return EBUSY;
|
||||||
|
|
||||||
|
//if ((pktsize = gUtil->dequeue_fifo_data(cookie->iface->wfifo, &bdata, B_INFINITE_TIMEOUT, false)) < 0)
|
||||||
|
pktsize = gUtil->dequeue_fifo_data(cookie->iface->wfifo, &bdata, cookie->blocking_io?B_INFINITE_TIMEOUT:0LL, false);
|
||||||
|
|
||||||
|
if (pktsize < 0) {
|
||||||
|
*numbytes = 0;
|
||||||
|
return pktsize;
|
||||||
|
}
|
||||||
|
#if DEBUG > 2
|
||||||
|
dprintf("tun: dequeue = %ld, datalen = %ld, \n", pktsize, bdata?bdata->datalen:0);
|
||||||
|
#endif
|
||||||
|
pktsize = (ssize_t)bdata->datalen;
|
||||||
|
|
||||||
|
got = gUtil->copy_from_data(bdata, 0L, data, MIN((bdata->datalen), (*numbytes)));
|
||||||
|
//got = MIN((*numbytes), bdata->datalen);
|
||||||
|
if ((pktsize > *numbytes) && !(cookie->iface->flags & TUN_NO_PI))
|
||||||
|
((struct tun_pi *)data)->flags |= TUN_PKT_STRIP;
|
||||||
|
gUtil->delete_data(bdata);
|
||||||
|
#if DEBUG > 2
|
||||||
|
dprintf("tun: read() got %ld bytes, buf is %ld\n", got, *numbytes);
|
||||||
|
dump_data(bdata);
|
||||||
|
iovec_dump_data(bdata);
|
||||||
|
#endif
|
||||||
|
*numbytes = got;
|
||||||
|
return B_OK;
|
||||||
|
ERROR_EOF:
|
||||||
|
*numbytes = 0;
|
||||||
|
return B_OK;
|
||||||
|
}
|
||||||
|
|
||||||
|
status_t tun_write(cookie_t *cookie, off_t position, const void *data, size_t *numbytes) {
|
||||||
|
bone_data_t *bdata = NULL;
|
||||||
|
void *buf;
|
||||||
|
status_t err = B_NO_MEMORY;
|
||||||
|
(void)position;
|
||||||
|
|
||||||
|
/* XXX: max for *numbytes ? */
|
||||||
|
|
||||||
|
if (cookie->iface == NULL)
|
||||||
|
return EBUSY;
|
||||||
|
bdata = gUtil->new_data();
|
||||||
|
if (bdata == NULL)
|
||||||
|
return B_NO_MEMORY;
|
||||||
|
buf = gUtil->falloc(*numbytes);
|
||||||
|
if (buf == NULL)
|
||||||
|
goto ERROR_1;
|
||||||
|
memcpy(buf, data, *numbytes);
|
||||||
|
|
||||||
|
if (gUtil->prepend_data(bdata, buf, *numbytes, gUtil->free) < 0) {
|
||||||
|
gUtil->free(buf);
|
||||||
|
goto ERROR_1;
|
||||||
|
}
|
||||||
|
if ((err = gUtil->enqueue_fifo_data(cookie->iface->rfifo, bdata)) < B_OK)
|
||||||
|
goto ERROR_1;
|
||||||
|
return B_OK;
|
||||||
|
|
||||||
|
ERROR_1:
|
||||||
|
if (bdata)
|
||||||
|
gUtil->delete_data(bdata);
|
||||||
|
return err;
|
||||||
|
}
|
||||||
|
|
||||||
|
status_t tun_select(cookie_t *cookie, uint8 event, uint32 ref, selectsync *sync)
|
||||||
|
{
|
||||||
|
status_t err = B_OK;
|
||||||
|
#if DEBUG > 1
|
||||||
|
dprintf("tun: select(, %d, %ld, )\n", event, ref);
|
||||||
|
#endif
|
||||||
|
if (cookie->iface == NULL)
|
||||||
|
return B_NO_INIT;
|
||||||
|
if (event > B_SELECT_EXCEPTION || !event)
|
||||||
|
return EINVAL;
|
||||||
|
err = gUtil->lock_benaphore(&cookie->iface->lock);
|
||||||
|
if (err < B_OK)
|
||||||
|
return err;
|
||||||
|
/* iface LOCKED */
|
||||||
|
if (cookie->iface->sel[event].sync)
|
||||||
|
err = EALREADY;
|
||||||
|
else {
|
||||||
|
bone_fifo_t *fifo = NULL;
|
||||||
|
switch (event) {
|
||||||
|
case B_SELECT_READ:
|
||||||
|
fifo = cookie->iface->wfifo;
|
||||||
|
break;
|
||||||
|
case B_SELECT_WRITE:
|
||||||
|
fifo = cookie->iface->rfifo;
|
||||||
|
break;
|
||||||
|
}
|
||||||
|
if (fifo) {
|
||||||
|
/* XXX: is it safe ??? shouldn't we dequeue(peek=true) ? */
|
||||||
|
err = gUtil->lock_benaphore(&fifo->lock);
|
||||||
|
if (err >= B_OK) {
|
||||||
|
bool avail;
|
||||||
|
switch (event) {
|
||||||
|
case B_SELECT_READ:
|
||||||
|
avail = (fifo->current_bytes > 1);
|
||||||
|
break;
|
||||||
|
case B_SELECT_WRITE:
|
||||||
|
avail = ((fifo->max_bytes - fifo->current_bytes) > cookie->iface->ifn->if_mtu);
|
||||||
|
break;
|
||||||
|
}
|
||||||
|
/* check if we don't already have the event */
|
||||||
|
if (avail) {
|
||||||
|
notify_select_event(sync, ref);
|
||||||
|
}
|
||||||
|
else {
|
||||||
|
cookie->iface->sel[event].sync = sync;
|
||||||
|
cookie->iface->sel[event].ref = ref;
|
||||||
|
}
|
||||||
|
gUtil->unlock_benaphore(&fifo->lock);
|
||||||
|
}
|
||||||
|
} else {
|
||||||
|
cookie->iface->sel[event].sync = sync;
|
||||||
|
cookie->iface->sel[event].ref = ref;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
gUtil->unlock_benaphore(&cookie->iface->lock);
|
||||||
|
/* iface UNLOCKED */
|
||||||
|
return err;
|
||||||
|
}
|
||||||
|
status_t tun_deselect(cookie_t *cookie, uint8 event, selectsync *sync)
|
||||||
|
{
|
||||||
|
status_t err = B_OK;
|
||||||
|
#if DEBUG > 1
|
||||||
|
dprintf("tun: deselect(, %d, )\n", event);
|
||||||
|
#endif
|
||||||
|
if (cookie->iface == NULL)
|
||||||
|
return B_NO_INIT;
|
||||||
|
if (event > B_SELECT_EXCEPTION || !event)
|
||||||
|
return EINVAL;
|
||||||
|
err = gUtil->lock_benaphore(&cookie->iface->lock);
|
||||||
|
if (err < B_OK)
|
||||||
|
return err;
|
||||||
|
cookie->iface->sel[event].sync = NULL;
|
||||||
|
cookie->iface->sel[event].ref = 0;
|
||||||
|
gUtil->unlock_benaphore(&cookie->iface->lock);
|
||||||
|
/* iface LOCKED */
|
||||||
|
return B_OK;
|
||||||
|
}
|
||||||
|
status_t tun_readv(cookie_t *cookie, off_t position, const iovec *vec, size_t count, size_t *numBytes)
|
||||||
|
{
|
||||||
|
dprintf("tun: readv(, %Ld, , %ld)\n", position, count);
|
||||||
|
return EOPNOTSUPP;
|
||||||
|
}
|
||||||
|
status_t tun_writev(cookie_t *cookie, off_t position, const iovec *vec, size_t count, size_t *numBytes)
|
||||||
|
{
|
||||||
|
dprintf("tun: writev(, %Ld, , %ld)\n", position, count);
|
||||||
|
return EOPNOTSUPP;
|
||||||
|
}
|
||||||
|
|
||||||
|
device_hooks tun_hooks={
|
||||||
|
(device_open_hook)tun_open,
|
||||||
|
tun_close,
|
||||||
|
(device_free_hook)tun_free,
|
||||||
|
(device_control_hook)tun_ioctl,
|
||||||
|
(device_read_hook)tun_read,
|
||||||
|
(device_write_hook)tun_write,
|
||||||
|
(device_select_hook)tun_select,
|
||||||
|
(device_deselect_hook)tun_deselect,
|
||||||
|
(device_readv_hook)tun_readv,
|
||||||
|
(device_writev_hook)tun_writev
|
||||||
|
};
|
||||||
Loading…
x
Reference in New Issue
Block a user