nexmon – Rev 1
?pathlinks?
/*
* Copyright (c) 2007, 2008, Andrea Bittau <a.bittau@cs.ucl.ac.uk>
*
* OS dependent API for FreeBSD. TAP routines
*
* This program is free software; you can redistribute it and/or modify
* it under the terms of the GNU General Public License as published by
* the Free Software Foundation; either version 2 of the License, or
* (at your option) any later version.
*
* This program is distributed in the hope that it will be useful,
* but WITHOUT ANY WARRANTY; without even the implied warranty of
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
* GNU General Public License for more details.
*
* You should have received a copy of the GNU General Public License
* along with this program; if not, write to the Free Software
* Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
*/
#include <sys/types.h>
#include <sys/stat.h>
#include <sys/ioctl.h>
#include <sys/time.h>
#include <sys/socket.h>
#include <net/if.h>
#include <fcntl.h>
#include <stdlib.h>
#include <unistd.h>
#include <stdio.h>
#include <string.h>
#include "osdep.h"
struct tip_fbsd {
int tf_fd;
int tf_ioctls;
struct ifreq tf_ifr;
char tf_name[MAX_IFACE_NAME];
int tf_destroy;
};
static int ti_do_open_fbsd(struct tif *ti, char *name)
{
int fd;
char *iface = "/dev/tap";
struct stat st;
struct tip_fbsd *priv = ti_priv(ti);
int s;
unsigned int flags;
struct ifreq *ifr;
/* open tap */
if (name)
iface = name;
else
priv->tf_destroy = 1; /* we create, we destroy */
fd = open(iface, O_RDWR);
if (fd == -1)
return -1;
/* get name */
if(fstat(fd, &st) == -1)
goto err;
snprintf(priv->tf_name, sizeof(priv->tf_name)-1, "%s",
devname(st.st_rdev, S_IFCHR));
/* bring iface up */
s = socket(PF_INET, SOCK_DGRAM, 0);
if (s == -1)
goto err;
priv->tf_ioctls = s;
/* get flags */
ifr = &priv->tf_ifr;
memset(ifr, 0, sizeof(*ifr));
snprintf(ifr->ifr_name, sizeof(ifr->ifr_name)-1, "%s", priv->tf_name);
if (ioctl(s, SIOCGIFFLAGS, ifr) == -1)
goto err2;
flags = (ifr->ifr_flags & 0xffff) | (ifr->ifr_flagshigh << 16);
/* set flags */
flags |= IFF_UP;
ifr->ifr_flags = flags & 0xffff;
ifr->ifr_flagshigh = flags >> 16;
if (ioctl(s, SIOCSIFFLAGS, ifr) == -1)
goto err2;
return fd;
err:
/* XXX destroy */
close(fd);
return -1;
err2:
close(s);
goto err;
}
static void ti_do_free(struct tif *ti)
{
struct tip_fbsd *priv = ti_priv(ti);
free(priv);
free(ti);
}
static void ti_destroy(struct tip_fbsd *priv)
{
ioctl(priv->tf_ioctls, SIOCIFDESTROY, &priv->tf_ifr);
}
static void ti_close_fbsd(struct tif *ti)
{
struct tip_fbsd *priv = ti_priv(ti);
if (priv->tf_destroy)
ti_destroy(priv);
close(priv->tf_fd);
close(priv->tf_ioctls);
ti_do_free(ti);
}
static char *ti_name_fbsd(struct tif *ti)
{
struct tip_fbsd *priv = ti_priv(ti);
return priv->tf_name;
}
static int ti_set_mtu_fbsd(struct tif *ti, int mtu)
{
struct tip_fbsd *priv = ti_priv(ti);
priv->tf_ifr.ifr_mtu = mtu;
return ioctl(priv->tf_ioctls, SIOCSIFMTU, &priv->tf_ifr);
}
static int ti_set_mac_fbsd(struct tif *ti, unsigned char *mac)
{
struct tip_fbsd *priv = ti_priv(ti);
struct ifreq *ifr = &priv->tf_ifr;
ifr->ifr_addr.sa_family = AF_LINK;
ifr->ifr_addr.sa_len = 6;
memcpy(ifr->ifr_addr.sa_data, mac, 6);
return ioctl(priv->tf_ioctls, SIOCSIFLLADDR, ifr);
}
static int ti_set_ip_fbsd(struct tif *ti, struct in_addr *ip)
{
struct tip_fbsd *priv = ti_priv(ti);
struct ifaliasreq ifra;
struct sockaddr_in *s_in;
/* assume same size */
memset(&ifra, 0, sizeof(ifra));
strcpy(ifra.ifra_name, priv->tf_ifr.ifr_name);
s_in = (struct sockaddr_in *) &ifra.ifra_addr;
s_in->sin_family = PF_INET;
s_in->sin_addr = *ip;
s_in->sin_len = sizeof(*s_in);
return ioctl(priv->tf_ioctls, SIOCAIFADDR, &ifra);
}
static int ti_fd_fbsd(struct tif *ti)
{
struct tip_fbsd *priv = ti_priv(ti);
return priv->tf_fd;
}
static int ti_read_fbsd(struct tif *ti, void *buf, int len)
{
return read(ti_fd(ti), buf, len);
}
static int ti_write_fbsd(struct tif *ti, void *buf, int len)
{
return write(ti_fd(ti), buf, len);
}
static struct tif *ti_open_fbsd(char *iface)
{
struct tif *ti;
struct tip_fbsd *priv;
int fd;
/* setup ti struct */
ti = ti_alloc(sizeof(*priv));
if (!ti)
return NULL;
ti->ti_name = ti_name_fbsd;
ti->ti_set_mtu = ti_set_mtu_fbsd;
ti->ti_close = ti_close_fbsd;
ti->ti_fd = ti_fd_fbsd;
ti->ti_read = ti_read_fbsd;
ti->ti_write = ti_write_fbsd;
ti->ti_set_mac = ti_set_mac_fbsd;
ti->ti_set_ip = ti_set_ip_fbsd;
/* setup iface */
fd = ti_do_open_fbsd(ti, iface);
if (fd == -1) {
ti_do_free(ti);
return NULL;
}
/* setup private state */
priv = ti_priv(ti);
priv->tf_fd = fd;
return ti;
}
struct tif *ti_open(char *iface)
{
return ti_open_fbsd(iface);
}