17718ced0SMaksim Yevmenkin /* $NetBSD: tap.c,v 1.1 2008/08/17 13:20:57 plunky Exp $ */ 27718ced0SMaksim Yevmenkin 37718ced0SMaksim Yevmenkin /*- 41de7b4b8SPedro F. Giffuni * SPDX-License-Identifier: BSD-2-Clause-NetBSD 51de7b4b8SPedro F. Giffuni * 67718ced0SMaksim Yevmenkin * Copyright (c) 2008 Iain Hibbert 77718ced0SMaksim Yevmenkin * All rights reserved. 87718ced0SMaksim Yevmenkin * 97718ced0SMaksim Yevmenkin * Redistribution and use in source and binary forms, with or without 107718ced0SMaksim Yevmenkin * modification, are permitted provided that the following conditions 117718ced0SMaksim Yevmenkin * are met: 127718ced0SMaksim Yevmenkin * 1. Redistributions of source code must retain the above copyright 137718ced0SMaksim Yevmenkin * notice, this list of conditions and the following disclaimer. 147718ced0SMaksim Yevmenkin * 2. Redistributions in binary form must reproduce the above copyright 157718ced0SMaksim Yevmenkin * notice, this list of conditions and the following disclaimer in the 167718ced0SMaksim Yevmenkin * documentation and/or other materials provided with the distribution. 177718ced0SMaksim Yevmenkin * 187718ced0SMaksim Yevmenkin * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR 197718ced0SMaksim Yevmenkin * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES 207718ced0SMaksim Yevmenkin * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. 217718ced0SMaksim Yevmenkin * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT, 227718ced0SMaksim Yevmenkin * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT 237718ced0SMaksim Yevmenkin * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, 247718ced0SMaksim Yevmenkin * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY 257718ced0SMaksim Yevmenkin * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT 267718ced0SMaksim Yevmenkin * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF 277718ced0SMaksim Yevmenkin * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. 287718ced0SMaksim Yevmenkin */ 297718ced0SMaksim Yevmenkin 307718ced0SMaksim Yevmenkin /* $FreeBSD$ */ 317718ced0SMaksim Yevmenkin 327718ced0SMaksim Yevmenkin #include <sys/cdefs.h> 337718ced0SMaksim Yevmenkin __RCSID("$NetBSD: tap.c,v 1.1 2008/08/17 13:20:57 plunky Exp $"); 347718ced0SMaksim Yevmenkin 357718ced0SMaksim Yevmenkin #include <sys/types.h> 367718ced0SMaksim Yevmenkin #include <sys/param.h> 377718ced0SMaksim Yevmenkin #include <sys/ioctl.h> 387718ced0SMaksim Yevmenkin #include <sys/uio.h> 397718ced0SMaksim Yevmenkin 407718ced0SMaksim Yevmenkin #include <net/if_tap.h> 417718ced0SMaksim Yevmenkin 427718ced0SMaksim Yevmenkin #include <fcntl.h> 437718ced0SMaksim Yevmenkin #include <libutil.h> 447718ced0SMaksim Yevmenkin #include <paths.h> 457718ced0SMaksim Yevmenkin #include <stdio.h> 467718ced0SMaksim Yevmenkin #include <unistd.h> 477718ced0SMaksim Yevmenkin 488d6f425dSTakanori Watanabe #define L2CAP_SOCKET_CHECKED 497718ced0SMaksim Yevmenkin #include "btpand.h" 507718ced0SMaksim Yevmenkin 517718ced0SMaksim Yevmenkin static bool tap_send(channel_t *, packet_t *); 527718ced0SMaksim Yevmenkin static bool tap_recv(packet_t *); 537718ced0SMaksim Yevmenkin 547718ced0SMaksim Yevmenkin void 557718ced0SMaksim Yevmenkin tap_init(void) 567718ced0SMaksim Yevmenkin { 577718ced0SMaksim Yevmenkin channel_t *chan; 587718ced0SMaksim Yevmenkin struct ifreq ifr; 597718ced0SMaksim Yevmenkin int fd, s; 607718ced0SMaksim Yevmenkin char pidfile[PATH_MAX]; 617718ced0SMaksim Yevmenkin 627718ced0SMaksim Yevmenkin fd = open(interface_name, O_RDWR); 637718ced0SMaksim Yevmenkin if (fd == -1) { 647718ced0SMaksim Yevmenkin log_err("Could not open \"%s\": %m", interface_name); 657718ced0SMaksim Yevmenkin exit(EXIT_FAILURE); 667718ced0SMaksim Yevmenkin } 677718ced0SMaksim Yevmenkin 687718ced0SMaksim Yevmenkin memset(&ifr, 0, sizeof(ifr)); 697718ced0SMaksim Yevmenkin if (ioctl(fd, TAPGIFNAME, &ifr) == -1) { 707718ced0SMaksim Yevmenkin log_err("Could not get interface name: %m"); 717718ced0SMaksim Yevmenkin exit(EXIT_FAILURE); 727718ced0SMaksim Yevmenkin } 737718ced0SMaksim Yevmenkin 747718ced0SMaksim Yevmenkin s = socket(AF_INET, SOCK_DGRAM, 0); 757718ced0SMaksim Yevmenkin if (s == -1) { 767718ced0SMaksim Yevmenkin log_err("Could not open PF_LINK socket: %m"); 777718ced0SMaksim Yevmenkin exit(EXIT_FAILURE); 787718ced0SMaksim Yevmenkin } 797718ced0SMaksim Yevmenkin 807718ced0SMaksim Yevmenkin ifr.ifr_addr.sa_family = AF_LINK; 817718ced0SMaksim Yevmenkin ifr.ifr_addr.sa_len = ETHER_ADDR_LEN; 827718ced0SMaksim Yevmenkin b2eaddr(ifr.ifr_addr.sa_data, &local_bdaddr); 837718ced0SMaksim Yevmenkin 847718ced0SMaksim Yevmenkin if (ioctl(s, SIOCSIFLLADDR, &ifr) == -1) { 857718ced0SMaksim Yevmenkin log_err("Could not set %s physical address: %m", ifr.ifr_name); 867718ced0SMaksim Yevmenkin exit(EXIT_FAILURE); 877718ced0SMaksim Yevmenkin } 887718ced0SMaksim Yevmenkin 897718ced0SMaksim Yevmenkin if (ioctl(s, SIOCGIFFLAGS, &ifr) == -1) { 907718ced0SMaksim Yevmenkin log_err("Could not get interface flags: %m"); 917718ced0SMaksim Yevmenkin exit(EXIT_FAILURE); 927718ced0SMaksim Yevmenkin } 937718ced0SMaksim Yevmenkin 947718ced0SMaksim Yevmenkin if ((ifr.ifr_flags & IFF_UP) == 0) { 957718ced0SMaksim Yevmenkin ifr.ifr_flags |= IFF_UP; 967718ced0SMaksim Yevmenkin 977718ced0SMaksim Yevmenkin if (ioctl(s, SIOCSIFFLAGS, &ifr) == -1) { 987718ced0SMaksim Yevmenkin log_err("Could not set IFF_UP: %m"); 997718ced0SMaksim Yevmenkin exit(EXIT_FAILURE); 1007718ced0SMaksim Yevmenkin } 1017718ced0SMaksim Yevmenkin } 1027718ced0SMaksim Yevmenkin 1037718ced0SMaksim Yevmenkin close(s); 1047718ced0SMaksim Yevmenkin 1057718ced0SMaksim Yevmenkin log_info("Using interface %s with addr %s", ifr.ifr_name, 1067718ced0SMaksim Yevmenkin ether_ntoa((struct ether_addr *)&ifr.ifr_addr.sa_data)); 1077718ced0SMaksim Yevmenkin 1087718ced0SMaksim Yevmenkin chan = channel_alloc(); 1097718ced0SMaksim Yevmenkin if (chan == NULL) 1107718ced0SMaksim Yevmenkin exit(EXIT_FAILURE); 1117718ced0SMaksim Yevmenkin 1127718ced0SMaksim Yevmenkin chan->send = tap_send; 1137718ced0SMaksim Yevmenkin chan->recv = tap_recv; 1147718ced0SMaksim Yevmenkin chan->mru = ETHER_HDR_LEN + ETHER_MAX_LEN; 1157718ced0SMaksim Yevmenkin memcpy(chan->raddr, ifr.ifr_addr.sa_data, ETHER_ADDR_LEN); 1167718ced0SMaksim Yevmenkin memcpy(chan->laddr, ifr.ifr_addr.sa_data, ETHER_ADDR_LEN); 1177718ced0SMaksim Yevmenkin chan->state = CHANNEL_OPEN; 1187718ced0SMaksim Yevmenkin if (!channel_open(chan, fd)) 1197718ced0SMaksim Yevmenkin exit(EXIT_FAILURE); 1207718ced0SMaksim Yevmenkin 1217718ced0SMaksim Yevmenkin snprintf(pidfile, sizeof(pidfile), "%s/%s.pid", 1227718ced0SMaksim Yevmenkin _PATH_VARRUN, ifr.ifr_name); 1237718ced0SMaksim Yevmenkin chan->pfh = pidfile_open(pidfile, 0600, NULL); 1247718ced0SMaksim Yevmenkin if (chan->pfh == NULL) 1257718ced0SMaksim Yevmenkin log_err("can't create pidfile"); 1267718ced0SMaksim Yevmenkin else if (pidfile_write(chan->pfh) < 0) { 1277718ced0SMaksim Yevmenkin log_err("can't write pidfile"); 1287718ced0SMaksim Yevmenkin pidfile_remove(chan->pfh); 1297718ced0SMaksim Yevmenkin chan->pfh = NULL; 1307718ced0SMaksim Yevmenkin } 1317718ced0SMaksim Yevmenkin } 1327718ced0SMaksim Yevmenkin 1337718ced0SMaksim Yevmenkin static bool 1347718ced0SMaksim Yevmenkin tap_send(channel_t *chan, packet_t *pkt) 1357718ced0SMaksim Yevmenkin { 1367718ced0SMaksim Yevmenkin struct iovec iov[4]; 1377718ced0SMaksim Yevmenkin ssize_t nw; 1387718ced0SMaksim Yevmenkin 1397718ced0SMaksim Yevmenkin iov[0].iov_base = pkt->dst; 1407718ced0SMaksim Yevmenkin iov[0].iov_len = ETHER_ADDR_LEN; 1417718ced0SMaksim Yevmenkin iov[1].iov_base = pkt->src; 1427718ced0SMaksim Yevmenkin iov[1].iov_len = ETHER_ADDR_LEN; 1437718ced0SMaksim Yevmenkin iov[2].iov_base = pkt->type; 1447718ced0SMaksim Yevmenkin iov[2].iov_len = ETHER_TYPE_LEN; 1457718ced0SMaksim Yevmenkin iov[3].iov_base = pkt->ptr; 1467718ced0SMaksim Yevmenkin iov[3].iov_len = pkt->len; 1477718ced0SMaksim Yevmenkin 1487718ced0SMaksim Yevmenkin /* tap device write never fails */ 1497718ced0SMaksim Yevmenkin nw = writev(chan->fd, iov, __arraycount(iov)); 1507718ced0SMaksim Yevmenkin assert(nw > 0); 1517718ced0SMaksim Yevmenkin 1527718ced0SMaksim Yevmenkin return true; 1537718ced0SMaksim Yevmenkin } 1547718ced0SMaksim Yevmenkin 1557718ced0SMaksim Yevmenkin static bool 1567718ced0SMaksim Yevmenkin tap_recv(packet_t *pkt) 1577718ced0SMaksim Yevmenkin { 1587718ced0SMaksim Yevmenkin 1597718ced0SMaksim Yevmenkin if (pkt->len < ETHER_HDR_LEN) 1607718ced0SMaksim Yevmenkin return false; 1617718ced0SMaksim Yevmenkin 1627718ced0SMaksim Yevmenkin pkt->dst = pkt->ptr; 1637718ced0SMaksim Yevmenkin packet_adj(pkt, ETHER_ADDR_LEN); 1647718ced0SMaksim Yevmenkin pkt->src = pkt->ptr; 1657718ced0SMaksim Yevmenkin packet_adj(pkt, ETHER_ADDR_LEN); 1667718ced0SMaksim Yevmenkin pkt->type = pkt->ptr; 1677718ced0SMaksim Yevmenkin packet_adj(pkt, ETHER_TYPE_LEN); 1687718ced0SMaksim Yevmenkin 1697718ced0SMaksim Yevmenkin return true; 1707718ced0SMaksim Yevmenkin } 171