17718ced0SMaksim Yevmenkin /* $NetBSD: channel.c,v 1.1 2008/08/17 13:20:57 plunky Exp $ */ 27718ced0SMaksim Yevmenkin 37718ced0SMaksim Yevmenkin /*- 47718ced0SMaksim Yevmenkin * Copyright (c) 2008 Iain Hibbert 57718ced0SMaksim Yevmenkin * All rights reserved. 67718ced0SMaksim Yevmenkin * 77718ced0SMaksim Yevmenkin * Redistribution and use in source and binary forms, with or without 87718ced0SMaksim Yevmenkin * modification, are permitted provided that the following conditions 97718ced0SMaksim Yevmenkin * are met: 107718ced0SMaksim Yevmenkin * 1. Redistributions of source code must retain the above copyright 117718ced0SMaksim Yevmenkin * notice, this list of conditions and the following disclaimer. 127718ced0SMaksim Yevmenkin * 2. Redistributions in binary form must reproduce the above copyright 137718ced0SMaksim Yevmenkin * notice, this list of conditions and the following disclaimer in the 147718ced0SMaksim Yevmenkin * documentation and/or other materials provided with the distribution. 157718ced0SMaksim Yevmenkin * 167718ced0SMaksim Yevmenkin * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR 177718ced0SMaksim Yevmenkin * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES 187718ced0SMaksim Yevmenkin * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. 197718ced0SMaksim Yevmenkin * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT, 207718ced0SMaksim Yevmenkin * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT 217718ced0SMaksim Yevmenkin * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, 227718ced0SMaksim Yevmenkin * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY 237718ced0SMaksim Yevmenkin * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT 247718ced0SMaksim Yevmenkin * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF 257718ced0SMaksim Yevmenkin * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. 267718ced0SMaksim Yevmenkin */ 277718ced0SMaksim Yevmenkin 287718ced0SMaksim Yevmenkin /* $FreeBSD$ */ 297718ced0SMaksim Yevmenkin 307718ced0SMaksim Yevmenkin #include <sys/cdefs.h> 317718ced0SMaksim Yevmenkin __RCSID("$NetBSD: channel.c,v 1.1 2008/08/17 13:20:57 plunky Exp $"); 327718ced0SMaksim Yevmenkin 337718ced0SMaksim Yevmenkin #include <sys/param.h> 347718ced0SMaksim Yevmenkin #include <sys/ioctl.h> 357718ced0SMaksim Yevmenkin 367718ced0SMaksim Yevmenkin #include <libutil.h> 377718ced0SMaksim Yevmenkin #include <unistd.h> 388d6f425dSTakanori Watanabe #define L2CAP_SOCKET_CHECKED 397718ced0SMaksim Yevmenkin #include "btpand.h" 407718ced0SMaksim Yevmenkin 417718ced0SMaksim Yevmenkin static struct chlist channel_list; 427718ced0SMaksim Yevmenkin static int channel_count; 437718ced0SMaksim Yevmenkin static int channel_tick; 447718ced0SMaksim Yevmenkin 457718ced0SMaksim Yevmenkin static void channel_start(int, short, void *); 467718ced0SMaksim Yevmenkin static void channel_read(int, short, void *); 477718ced0SMaksim Yevmenkin static void channel_dispatch(packet_t *); 487718ced0SMaksim Yevmenkin static void channel_watchdog(int, short, void *); 497718ced0SMaksim Yevmenkin 507718ced0SMaksim Yevmenkin void 517718ced0SMaksim Yevmenkin channel_init(void) 527718ced0SMaksim Yevmenkin { 537718ced0SMaksim Yevmenkin 547718ced0SMaksim Yevmenkin LIST_INIT(&channel_list); 557718ced0SMaksim Yevmenkin } 567718ced0SMaksim Yevmenkin 577718ced0SMaksim Yevmenkin channel_t * 587718ced0SMaksim Yevmenkin channel_alloc(void) 597718ced0SMaksim Yevmenkin { 607718ced0SMaksim Yevmenkin channel_t *chan; 617718ced0SMaksim Yevmenkin 627718ced0SMaksim Yevmenkin chan = malloc(sizeof(channel_t)); 637718ced0SMaksim Yevmenkin if (chan == NULL) { 647718ced0SMaksim Yevmenkin log_err("%s() failed: %m", __func__); 657718ced0SMaksim Yevmenkin return NULL; 667718ced0SMaksim Yevmenkin } 677718ced0SMaksim Yevmenkin 687718ced0SMaksim Yevmenkin memset(chan, 0, sizeof(channel_t)); 697718ced0SMaksim Yevmenkin STAILQ_INIT(&chan->pktlist); 707718ced0SMaksim Yevmenkin chan->state = CHANNEL_CLOSED; 717718ced0SMaksim Yevmenkin LIST_INSERT_HEAD(&channel_list, chan, next); 727718ced0SMaksim Yevmenkin 737718ced0SMaksim Yevmenkin server_update(++channel_count); 747718ced0SMaksim Yevmenkin 757718ced0SMaksim Yevmenkin return chan; 767718ced0SMaksim Yevmenkin } 777718ced0SMaksim Yevmenkin 787718ced0SMaksim Yevmenkin bool 797718ced0SMaksim Yevmenkin channel_open(channel_t *chan, int fd) 807718ced0SMaksim Yevmenkin { 817718ced0SMaksim Yevmenkin int n; 827718ced0SMaksim Yevmenkin 837718ced0SMaksim Yevmenkin assert(chan->refcnt == 0); 847718ced0SMaksim Yevmenkin assert(chan->state != CHANNEL_CLOSED); 857718ced0SMaksim Yevmenkin 867718ced0SMaksim Yevmenkin if (chan->mtu > 0) { 877718ced0SMaksim Yevmenkin chan->sendbuf = malloc(chan->mtu); 887718ced0SMaksim Yevmenkin if (chan->sendbuf == NULL) { 897718ced0SMaksim Yevmenkin log_err("Could not malloc channel sendbuf: %m"); 907718ced0SMaksim Yevmenkin return false; 917718ced0SMaksim Yevmenkin } 927718ced0SMaksim Yevmenkin } 937718ced0SMaksim Yevmenkin 947718ced0SMaksim Yevmenkin n = 1; 957718ced0SMaksim Yevmenkin if (ioctl(fd, FIONBIO, &n) == -1) { 967718ced0SMaksim Yevmenkin log_err("Could not set non-blocking IO: %m"); 977718ced0SMaksim Yevmenkin return false; 987718ced0SMaksim Yevmenkin } 997718ced0SMaksim Yevmenkin 1007718ced0SMaksim Yevmenkin event_set(&chan->rd_ev, fd, EV_READ | EV_PERSIST, channel_read, chan); 1017718ced0SMaksim Yevmenkin if (event_add(&chan->rd_ev, NULL) == -1) { 1027718ced0SMaksim Yevmenkin log_err("Could not add channel read event: %m"); 1037718ced0SMaksim Yevmenkin return false; 1047718ced0SMaksim Yevmenkin } 1057718ced0SMaksim Yevmenkin 1067718ced0SMaksim Yevmenkin event_set(&chan->wr_ev, fd, EV_WRITE, channel_start, chan); 1077718ced0SMaksim Yevmenkin 1087718ced0SMaksim Yevmenkin chan->refcnt++; 1097718ced0SMaksim Yevmenkin chan->fd = fd; 1107718ced0SMaksim Yevmenkin 1117718ced0SMaksim Yevmenkin log_debug("(fd#%d)", chan->fd); 1127718ced0SMaksim Yevmenkin 1137718ced0SMaksim Yevmenkin return true; 1147718ced0SMaksim Yevmenkin } 1157718ced0SMaksim Yevmenkin 1167718ced0SMaksim Yevmenkin void 1177718ced0SMaksim Yevmenkin channel_close(channel_t *chan) 1187718ced0SMaksim Yevmenkin { 1197718ced0SMaksim Yevmenkin pkthdr_t *ph; 1207718ced0SMaksim Yevmenkin 1217718ced0SMaksim Yevmenkin assert(chan->state != CHANNEL_CLOSED); 1227718ced0SMaksim Yevmenkin 1237718ced0SMaksim Yevmenkin log_debug("(fd#%d)", chan->fd); 1247718ced0SMaksim Yevmenkin 1257718ced0SMaksim Yevmenkin chan->state = CHANNEL_CLOSED; 1267718ced0SMaksim Yevmenkin event_del(&chan->rd_ev); 1277718ced0SMaksim Yevmenkin event_del(&chan->wr_ev); 1287718ced0SMaksim Yevmenkin close(chan->fd); 1297718ced0SMaksim Yevmenkin chan->refcnt--; 1307718ced0SMaksim Yevmenkin chan->tick = 0; 1317718ced0SMaksim Yevmenkin 1327718ced0SMaksim Yevmenkin while ((ph = STAILQ_FIRST(&chan->pktlist)) != NULL) { 1337718ced0SMaksim Yevmenkin STAILQ_REMOVE_HEAD(&chan->pktlist, next); 1347718ced0SMaksim Yevmenkin pkthdr_free(ph); 1357718ced0SMaksim Yevmenkin chan->qlen--; 1367718ced0SMaksim Yevmenkin } 1377718ced0SMaksim Yevmenkin 1387718ced0SMaksim Yevmenkin if (chan->pfh != NULL) { 1397718ced0SMaksim Yevmenkin pidfile_remove(chan->pfh); 1407718ced0SMaksim Yevmenkin chan->pfh = NULL; 1417718ced0SMaksim Yevmenkin } 1427718ced0SMaksim Yevmenkin 1437718ced0SMaksim Yevmenkin if (chan->refcnt == 0) 1447718ced0SMaksim Yevmenkin channel_free(chan); 1457718ced0SMaksim Yevmenkin } 1467718ced0SMaksim Yevmenkin 1477718ced0SMaksim Yevmenkin void 1487718ced0SMaksim Yevmenkin channel_free(channel_t *chan) 1497718ced0SMaksim Yevmenkin { 1507718ced0SMaksim Yevmenkin 1517718ced0SMaksim Yevmenkin assert(chan->refcnt == 0); 1527718ced0SMaksim Yevmenkin assert(chan->state == CHANNEL_CLOSED); 1537718ced0SMaksim Yevmenkin assert(chan->qlen == 0); 1547718ced0SMaksim Yevmenkin assert(STAILQ_EMPTY(&chan->pktlist)); 1557718ced0SMaksim Yevmenkin 1567718ced0SMaksim Yevmenkin LIST_REMOVE(chan, next); 1577718ced0SMaksim Yevmenkin free(chan->pfilter); 1587718ced0SMaksim Yevmenkin free(chan->mfilter); 1597718ced0SMaksim Yevmenkin free(chan->sendbuf); 1607718ced0SMaksim Yevmenkin free(chan); 1617718ced0SMaksim Yevmenkin 1627718ced0SMaksim Yevmenkin server_update(--channel_count); 1637718ced0SMaksim Yevmenkin 1647718ced0SMaksim Yevmenkin if (server_limit == 0) { 1657718ced0SMaksim Yevmenkin log_info("connection closed, exiting"); 1667718ced0SMaksim Yevmenkin exit(EXIT_SUCCESS); 1677718ced0SMaksim Yevmenkin } 1687718ced0SMaksim Yevmenkin } 1697718ced0SMaksim Yevmenkin 1707718ced0SMaksim Yevmenkin static void 1717718ced0SMaksim Yevmenkin channel_start(int fd, short ev, void *arg) 1727718ced0SMaksim Yevmenkin { 1737718ced0SMaksim Yevmenkin channel_t *chan = arg; 1747718ced0SMaksim Yevmenkin pkthdr_t *ph; 1757718ced0SMaksim Yevmenkin 1767718ced0SMaksim Yevmenkin chan->oactive = true; 1777718ced0SMaksim Yevmenkin 1787718ced0SMaksim Yevmenkin while (chan->qlen > 0) { 1797718ced0SMaksim Yevmenkin ph = STAILQ_FIRST(&chan->pktlist); 1807718ced0SMaksim Yevmenkin 1817718ced0SMaksim Yevmenkin channel_timeout(chan, 10); 1827718ced0SMaksim Yevmenkin if (chan->send(chan, ph->data) == false) { 1837718ced0SMaksim Yevmenkin if (event_add(&chan->wr_ev, NULL) == -1) { 1847718ced0SMaksim Yevmenkin log_err("Could not add channel write event: %m"); 1857718ced0SMaksim Yevmenkin channel_close(chan); 1867718ced0SMaksim Yevmenkin } 1877718ced0SMaksim Yevmenkin return; 1887718ced0SMaksim Yevmenkin } 1897718ced0SMaksim Yevmenkin 1907718ced0SMaksim Yevmenkin STAILQ_REMOVE_HEAD(&chan->pktlist, next); 1917718ced0SMaksim Yevmenkin pkthdr_free(ph); 1927718ced0SMaksim Yevmenkin chan->qlen--; 1937718ced0SMaksim Yevmenkin } 1947718ced0SMaksim Yevmenkin 1957718ced0SMaksim Yevmenkin channel_timeout(chan, 0); 1967718ced0SMaksim Yevmenkin chan->oactive = false; 1977718ced0SMaksim Yevmenkin } 1987718ced0SMaksim Yevmenkin 1997718ced0SMaksim Yevmenkin static void 2007718ced0SMaksim Yevmenkin channel_read(int fd, short ev, void *arg) 2017718ced0SMaksim Yevmenkin { 2027718ced0SMaksim Yevmenkin channel_t *chan = arg; 2037718ced0SMaksim Yevmenkin packet_t *pkt; 2047718ced0SMaksim Yevmenkin ssize_t nr; 2057718ced0SMaksim Yevmenkin 2067718ced0SMaksim Yevmenkin pkt = packet_alloc(chan); 2077718ced0SMaksim Yevmenkin if (pkt == NULL) { 2087718ced0SMaksim Yevmenkin channel_close(chan); 2097718ced0SMaksim Yevmenkin return; 2107718ced0SMaksim Yevmenkin } 2117718ced0SMaksim Yevmenkin 2127718ced0SMaksim Yevmenkin nr = read(fd, pkt->buf, chan->mru); 2137718ced0SMaksim Yevmenkin if (nr == -1) { 2147718ced0SMaksim Yevmenkin log_err("channel read error: %m"); 2157718ced0SMaksim Yevmenkin packet_free(pkt); 2167718ced0SMaksim Yevmenkin channel_close(chan); 2177718ced0SMaksim Yevmenkin return; 2187718ced0SMaksim Yevmenkin } 2197718ced0SMaksim Yevmenkin if (nr == 0) { /* EOF */ 2207718ced0SMaksim Yevmenkin log_debug("(fd#%d) EOF", fd); 2217718ced0SMaksim Yevmenkin packet_free(pkt); 2227718ced0SMaksim Yevmenkin channel_close(chan); 2237718ced0SMaksim Yevmenkin return; 2247718ced0SMaksim Yevmenkin } 2257718ced0SMaksim Yevmenkin pkt->len = nr; 2267718ced0SMaksim Yevmenkin 2277718ced0SMaksim Yevmenkin if (chan->recv(pkt) == true) 2287718ced0SMaksim Yevmenkin channel_dispatch(pkt); 2297718ced0SMaksim Yevmenkin 2307718ced0SMaksim Yevmenkin packet_free(pkt); 2317718ced0SMaksim Yevmenkin } 2327718ced0SMaksim Yevmenkin 2337718ced0SMaksim Yevmenkin static void 2347718ced0SMaksim Yevmenkin channel_dispatch(packet_t *pkt) 2357718ced0SMaksim Yevmenkin { 2367718ced0SMaksim Yevmenkin channel_t *chan; 2377718ced0SMaksim Yevmenkin 2387718ced0SMaksim Yevmenkin /* 2397718ced0SMaksim Yevmenkin * This is simple routing. I'm not sure if its allowed by 2407718ced0SMaksim Yevmenkin * the PAN or BNEP specifications, but it seems logical 2417718ced0SMaksim Yevmenkin * to send unicast packets to connected destinations where 2427718ced0SMaksim Yevmenkin * possible. 2437718ced0SMaksim Yevmenkin */ 2447718ced0SMaksim Yevmenkin if (!ETHER_IS_MULTICAST(pkt->dst)) { 2457718ced0SMaksim Yevmenkin LIST_FOREACH(chan, &channel_list, next) { 2467718ced0SMaksim Yevmenkin if (chan == pkt->chan 2477718ced0SMaksim Yevmenkin || chan->state != CHANNEL_OPEN) 2487718ced0SMaksim Yevmenkin continue; 2497718ced0SMaksim Yevmenkin 2507718ced0SMaksim Yevmenkin if (memcmp(pkt->dst, chan->raddr, ETHER_ADDR_LEN) == 0) { 2517718ced0SMaksim Yevmenkin if (chan->qlen > CHANNEL_MAXQLEN) 2527718ced0SMaksim Yevmenkin log_notice("Queue overflow"); 2537718ced0SMaksim Yevmenkin else 2547718ced0SMaksim Yevmenkin channel_put(chan, pkt); 2557718ced0SMaksim Yevmenkin 2567718ced0SMaksim Yevmenkin return; 2577718ced0SMaksim Yevmenkin } 2587718ced0SMaksim Yevmenkin } 2597718ced0SMaksim Yevmenkin } 2607718ced0SMaksim Yevmenkin 2617718ced0SMaksim Yevmenkin LIST_FOREACH(chan, &channel_list, next) { 2627718ced0SMaksim Yevmenkin if (chan == pkt->chan 2637718ced0SMaksim Yevmenkin || chan->state != CHANNEL_OPEN) 2647718ced0SMaksim Yevmenkin continue; 2657718ced0SMaksim Yevmenkin 2667718ced0SMaksim Yevmenkin if (chan->qlen > CHANNEL_MAXQLEN) { 2677718ced0SMaksim Yevmenkin log_notice("Queue overflow"); 2687718ced0SMaksim Yevmenkin continue; 2697718ced0SMaksim Yevmenkin } 2707718ced0SMaksim Yevmenkin 2717718ced0SMaksim Yevmenkin channel_put(chan, pkt); 2727718ced0SMaksim Yevmenkin } 2737718ced0SMaksim Yevmenkin } 2747718ced0SMaksim Yevmenkin 2757718ced0SMaksim Yevmenkin void 2767718ced0SMaksim Yevmenkin channel_put(channel_t *chan, packet_t *pkt) 2777718ced0SMaksim Yevmenkin { 2787718ced0SMaksim Yevmenkin pkthdr_t *ph; 2797718ced0SMaksim Yevmenkin 2807718ced0SMaksim Yevmenkin ph = pkthdr_alloc(pkt); 2817718ced0SMaksim Yevmenkin if (ph == NULL) 2827718ced0SMaksim Yevmenkin return; 2837718ced0SMaksim Yevmenkin 2847718ced0SMaksim Yevmenkin chan->qlen++; 2857718ced0SMaksim Yevmenkin STAILQ_INSERT_TAIL(&chan->pktlist, ph, next); 2867718ced0SMaksim Yevmenkin 2877718ced0SMaksim Yevmenkin if (!chan->oactive) 2887718ced0SMaksim Yevmenkin channel_start(chan->fd, EV_WRITE, chan); 2897718ced0SMaksim Yevmenkin } 2907718ced0SMaksim Yevmenkin 2917718ced0SMaksim Yevmenkin /* 2927718ced0SMaksim Yevmenkin * Simple watchdog timer, only ticks when it is required and 2937718ced0SMaksim Yevmenkin * closes the channel down if it times out. 2947718ced0SMaksim Yevmenkin */ 2957718ced0SMaksim Yevmenkin void 2967718ced0SMaksim Yevmenkin channel_timeout(channel_t *chan, int to) 2977718ced0SMaksim Yevmenkin { 2987718ced0SMaksim Yevmenkin static struct event ev; 2997718ced0SMaksim Yevmenkin 3007718ced0SMaksim Yevmenkin if (to == 0) 3017718ced0SMaksim Yevmenkin chan->tick = 0; 3027718ced0SMaksim Yevmenkin else 3037718ced0SMaksim Yevmenkin chan->tick = (channel_tick + to) % 60; 3047718ced0SMaksim Yevmenkin 3057718ced0SMaksim Yevmenkin if (channel_tick == 0) { 3067718ced0SMaksim Yevmenkin evtimer_set(&ev, channel_watchdog, &ev); 3077718ced0SMaksim Yevmenkin channel_watchdog(0, 0, &ev); 3087718ced0SMaksim Yevmenkin } 3097718ced0SMaksim Yevmenkin } 3107718ced0SMaksim Yevmenkin 3117718ced0SMaksim Yevmenkin static void 3127718ced0SMaksim Yevmenkin channel_watchdog(int fd, short ev, void *arg) 3137718ced0SMaksim Yevmenkin { 3147718ced0SMaksim Yevmenkin static struct timeval tv = { .tv_sec = 1 }; 3157718ced0SMaksim Yevmenkin channel_t *chan, *next; 3167718ced0SMaksim Yevmenkin int tick; 3177718ced0SMaksim Yevmenkin 3187718ced0SMaksim Yevmenkin tick = (channel_tick % 60) + 1; 3197718ced0SMaksim Yevmenkin channel_tick = 0; 3207718ced0SMaksim Yevmenkin 3217718ced0SMaksim Yevmenkin next = LIST_FIRST(&channel_list); 3227718ced0SMaksim Yevmenkin while ((chan = next) != NULL) { 3237718ced0SMaksim Yevmenkin next = LIST_NEXT(chan, next); 3247718ced0SMaksim Yevmenkin 3257718ced0SMaksim Yevmenkin if (chan->tick == tick) 3267718ced0SMaksim Yevmenkin channel_close(chan); 3277718ced0SMaksim Yevmenkin else if (chan->tick != 0) 3287718ced0SMaksim Yevmenkin channel_tick = tick; 3297718ced0SMaksim Yevmenkin } 3307718ced0SMaksim Yevmenkin 3317718ced0SMaksim Yevmenkin if (channel_tick != 0 && evtimer_add(arg, &tv) < 0) { 3327718ced0SMaksim Yevmenkin log_err("Could not add watchdog event: %m"); 3337718ced0SMaksim Yevmenkin exit(EXIT_FAILURE); 3347718ced0SMaksim Yevmenkin } 3357718ced0SMaksim Yevmenkin } 336