17718ced0SMaksim Yevmenkin /* $NetBSD: channel.c,v 1.1 2008/08/17 13:20:57 plunky Exp $ */
27718ced0SMaksim Yevmenkin
37718ced0SMaksim Yevmenkin /*-
4b61a5730SWarner Losh * SPDX-License-Identifier: BSD-2-Clause
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
317718ced0SMaksim Yevmenkin #include <sys/cdefs.h>
327718ced0SMaksim Yevmenkin __RCSID("$NetBSD: channel.c,v 1.1 2008/08/17 13:20:57 plunky Exp $");
337718ced0SMaksim Yevmenkin
347718ced0SMaksim Yevmenkin #include <sys/param.h>
357718ced0SMaksim Yevmenkin #include <sys/ioctl.h>
367718ced0SMaksim Yevmenkin
377718ced0SMaksim Yevmenkin #include <libutil.h>
387718ced0SMaksim Yevmenkin #include <unistd.h>
398d6f425dSTakanori Watanabe #define L2CAP_SOCKET_CHECKED
407718ced0SMaksim Yevmenkin #include "btpand.h"
417718ced0SMaksim Yevmenkin
427718ced0SMaksim Yevmenkin static struct chlist channel_list;
437718ced0SMaksim Yevmenkin static int channel_count;
447718ced0SMaksim Yevmenkin static int channel_tick;
457718ced0SMaksim Yevmenkin
467718ced0SMaksim Yevmenkin static void channel_start(int, short, void *);
477718ced0SMaksim Yevmenkin static void channel_read(int, short, void *);
487718ced0SMaksim Yevmenkin static void channel_dispatch(packet_t *);
497718ced0SMaksim Yevmenkin static void channel_watchdog(int, short, void *);
507718ced0SMaksim Yevmenkin
517718ced0SMaksim Yevmenkin void
channel_init(void)527718ced0SMaksim Yevmenkin channel_init(void)
537718ced0SMaksim Yevmenkin {
547718ced0SMaksim Yevmenkin
557718ced0SMaksim Yevmenkin LIST_INIT(&channel_list);
567718ced0SMaksim Yevmenkin }
577718ced0SMaksim Yevmenkin
587718ced0SMaksim Yevmenkin channel_t *
channel_alloc(void)597718ced0SMaksim Yevmenkin channel_alloc(void)
607718ced0SMaksim Yevmenkin {
617718ced0SMaksim Yevmenkin channel_t *chan;
627718ced0SMaksim Yevmenkin
637718ced0SMaksim Yevmenkin chan = malloc(sizeof(channel_t));
647718ced0SMaksim Yevmenkin if (chan == NULL) {
657718ced0SMaksim Yevmenkin log_err("%s() failed: %m", __func__);
667718ced0SMaksim Yevmenkin return NULL;
677718ced0SMaksim Yevmenkin }
687718ced0SMaksim Yevmenkin
697718ced0SMaksim Yevmenkin memset(chan, 0, sizeof(channel_t));
707718ced0SMaksim Yevmenkin STAILQ_INIT(&chan->pktlist);
717718ced0SMaksim Yevmenkin chan->state = CHANNEL_CLOSED;
727718ced0SMaksim Yevmenkin LIST_INSERT_HEAD(&channel_list, chan, next);
737718ced0SMaksim Yevmenkin
747718ced0SMaksim Yevmenkin server_update(++channel_count);
757718ced0SMaksim Yevmenkin
767718ced0SMaksim Yevmenkin return chan;
777718ced0SMaksim Yevmenkin }
787718ced0SMaksim Yevmenkin
797718ced0SMaksim Yevmenkin bool
channel_open(channel_t * chan,int fd)807718ced0SMaksim Yevmenkin channel_open(channel_t *chan, int fd)
817718ced0SMaksim Yevmenkin {
827718ced0SMaksim Yevmenkin int n;
837718ced0SMaksim Yevmenkin
847718ced0SMaksim Yevmenkin assert(chan->refcnt == 0);
857718ced0SMaksim Yevmenkin assert(chan->state != CHANNEL_CLOSED);
867718ced0SMaksim Yevmenkin
877718ced0SMaksim Yevmenkin if (chan->mtu > 0) {
887718ced0SMaksim Yevmenkin chan->sendbuf = malloc(chan->mtu);
897718ced0SMaksim Yevmenkin if (chan->sendbuf == NULL) {
907718ced0SMaksim Yevmenkin log_err("Could not malloc channel sendbuf: %m");
917718ced0SMaksim Yevmenkin return false;
927718ced0SMaksim Yevmenkin }
937718ced0SMaksim Yevmenkin }
947718ced0SMaksim Yevmenkin
957718ced0SMaksim Yevmenkin n = 1;
967718ced0SMaksim Yevmenkin if (ioctl(fd, FIONBIO, &n) == -1) {
977718ced0SMaksim Yevmenkin log_err("Could not set non-blocking IO: %m");
987718ced0SMaksim Yevmenkin return false;
997718ced0SMaksim Yevmenkin }
1007718ced0SMaksim Yevmenkin
1017718ced0SMaksim Yevmenkin event_set(&chan->rd_ev, fd, EV_READ | EV_PERSIST, channel_read, chan);
1027718ced0SMaksim Yevmenkin if (event_add(&chan->rd_ev, NULL) == -1) {
1037718ced0SMaksim Yevmenkin log_err("Could not add channel read event: %m");
1047718ced0SMaksim Yevmenkin return false;
1057718ced0SMaksim Yevmenkin }
1067718ced0SMaksim Yevmenkin
1077718ced0SMaksim Yevmenkin event_set(&chan->wr_ev, fd, EV_WRITE, channel_start, chan);
1087718ced0SMaksim Yevmenkin
1097718ced0SMaksim Yevmenkin chan->refcnt++;
1107718ced0SMaksim Yevmenkin chan->fd = fd;
1117718ced0SMaksim Yevmenkin
1127718ced0SMaksim Yevmenkin log_debug("(fd#%d)", chan->fd);
1137718ced0SMaksim Yevmenkin
1147718ced0SMaksim Yevmenkin return true;
1157718ced0SMaksim Yevmenkin }
1167718ced0SMaksim Yevmenkin
1177718ced0SMaksim Yevmenkin void
channel_close(channel_t * chan)1187718ced0SMaksim Yevmenkin channel_close(channel_t *chan)
1197718ced0SMaksim Yevmenkin {
1207718ced0SMaksim Yevmenkin pkthdr_t *ph;
1217718ced0SMaksim Yevmenkin
1227718ced0SMaksim Yevmenkin assert(chan->state != CHANNEL_CLOSED);
1237718ced0SMaksim Yevmenkin
1247718ced0SMaksim Yevmenkin log_debug("(fd#%d)", chan->fd);
1257718ced0SMaksim Yevmenkin
1267718ced0SMaksim Yevmenkin chan->state = CHANNEL_CLOSED;
1277718ced0SMaksim Yevmenkin event_del(&chan->rd_ev);
1287718ced0SMaksim Yevmenkin event_del(&chan->wr_ev);
1297718ced0SMaksim Yevmenkin close(chan->fd);
1307718ced0SMaksim Yevmenkin chan->refcnt--;
1317718ced0SMaksim Yevmenkin chan->tick = 0;
1327718ced0SMaksim Yevmenkin
1337718ced0SMaksim Yevmenkin while ((ph = STAILQ_FIRST(&chan->pktlist)) != NULL) {
1347718ced0SMaksim Yevmenkin STAILQ_REMOVE_HEAD(&chan->pktlist, next);
1357718ced0SMaksim Yevmenkin pkthdr_free(ph);
1367718ced0SMaksim Yevmenkin chan->qlen--;
1377718ced0SMaksim Yevmenkin }
1387718ced0SMaksim Yevmenkin
1397718ced0SMaksim Yevmenkin if (chan->pfh != NULL) {
1407718ced0SMaksim Yevmenkin pidfile_remove(chan->pfh);
1417718ced0SMaksim Yevmenkin chan->pfh = NULL;
1427718ced0SMaksim Yevmenkin }
1437718ced0SMaksim Yevmenkin
1447718ced0SMaksim Yevmenkin if (chan->refcnt == 0)
1457718ced0SMaksim Yevmenkin channel_free(chan);
1467718ced0SMaksim Yevmenkin }
1477718ced0SMaksim Yevmenkin
1487718ced0SMaksim Yevmenkin void
channel_free(channel_t * chan)1497718ced0SMaksim Yevmenkin channel_free(channel_t *chan)
1507718ced0SMaksim Yevmenkin {
1517718ced0SMaksim Yevmenkin
1527718ced0SMaksim Yevmenkin assert(chan->refcnt == 0);
1537718ced0SMaksim Yevmenkin assert(chan->state == CHANNEL_CLOSED);
1547718ced0SMaksim Yevmenkin assert(chan->qlen == 0);
1557718ced0SMaksim Yevmenkin assert(STAILQ_EMPTY(&chan->pktlist));
1567718ced0SMaksim Yevmenkin
1577718ced0SMaksim Yevmenkin LIST_REMOVE(chan, next);
1587718ced0SMaksim Yevmenkin free(chan->pfilter);
1597718ced0SMaksim Yevmenkin free(chan->mfilter);
1607718ced0SMaksim Yevmenkin free(chan->sendbuf);
1617718ced0SMaksim Yevmenkin free(chan);
1627718ced0SMaksim Yevmenkin
1637718ced0SMaksim Yevmenkin server_update(--channel_count);
1647718ced0SMaksim Yevmenkin
1657718ced0SMaksim Yevmenkin if (server_limit == 0) {
1667718ced0SMaksim Yevmenkin log_info("connection closed, exiting");
1677718ced0SMaksim Yevmenkin exit(EXIT_SUCCESS);
1687718ced0SMaksim Yevmenkin }
1697718ced0SMaksim Yevmenkin }
1707718ced0SMaksim Yevmenkin
1717718ced0SMaksim Yevmenkin static void
channel_start(int fd,short ev,void * arg)1727718ced0SMaksim Yevmenkin channel_start(int fd, short ev, void *arg)
1737718ced0SMaksim Yevmenkin {
1747718ced0SMaksim Yevmenkin channel_t *chan = arg;
1757718ced0SMaksim Yevmenkin pkthdr_t *ph;
1767718ced0SMaksim Yevmenkin
1777718ced0SMaksim Yevmenkin chan->oactive = true;
1787718ced0SMaksim Yevmenkin
1797718ced0SMaksim Yevmenkin while (chan->qlen > 0) {
1807718ced0SMaksim Yevmenkin ph = STAILQ_FIRST(&chan->pktlist);
1817718ced0SMaksim Yevmenkin
1827718ced0SMaksim Yevmenkin channel_timeout(chan, 10);
1837718ced0SMaksim Yevmenkin if (chan->send(chan, ph->data) == false) {
1847718ced0SMaksim Yevmenkin if (event_add(&chan->wr_ev, NULL) == -1) {
1857718ced0SMaksim Yevmenkin log_err("Could not add channel write event: %m");
1867718ced0SMaksim Yevmenkin channel_close(chan);
1877718ced0SMaksim Yevmenkin }
1887718ced0SMaksim Yevmenkin return;
1897718ced0SMaksim Yevmenkin }
1907718ced0SMaksim Yevmenkin
1917718ced0SMaksim Yevmenkin STAILQ_REMOVE_HEAD(&chan->pktlist, next);
1927718ced0SMaksim Yevmenkin pkthdr_free(ph);
1937718ced0SMaksim Yevmenkin chan->qlen--;
1947718ced0SMaksim Yevmenkin }
1957718ced0SMaksim Yevmenkin
1967718ced0SMaksim Yevmenkin channel_timeout(chan, 0);
1977718ced0SMaksim Yevmenkin chan->oactive = false;
1987718ced0SMaksim Yevmenkin }
1997718ced0SMaksim Yevmenkin
2007718ced0SMaksim Yevmenkin static void
channel_read(int fd,short ev,void * arg)2017718ced0SMaksim Yevmenkin channel_read(int fd, short ev, void *arg)
2027718ced0SMaksim Yevmenkin {
2037718ced0SMaksim Yevmenkin channel_t *chan = arg;
2047718ced0SMaksim Yevmenkin packet_t *pkt;
2057718ced0SMaksim Yevmenkin ssize_t nr;
2067718ced0SMaksim Yevmenkin
2077718ced0SMaksim Yevmenkin pkt = packet_alloc(chan);
2087718ced0SMaksim Yevmenkin if (pkt == NULL) {
2097718ced0SMaksim Yevmenkin channel_close(chan);
2107718ced0SMaksim Yevmenkin return;
2117718ced0SMaksim Yevmenkin }
2127718ced0SMaksim Yevmenkin
2137718ced0SMaksim Yevmenkin nr = read(fd, pkt->buf, chan->mru);
2147718ced0SMaksim Yevmenkin if (nr == -1) {
2157718ced0SMaksim Yevmenkin log_err("channel read error: %m");
2167718ced0SMaksim Yevmenkin packet_free(pkt);
2177718ced0SMaksim Yevmenkin channel_close(chan);
2187718ced0SMaksim Yevmenkin return;
2197718ced0SMaksim Yevmenkin }
2207718ced0SMaksim Yevmenkin if (nr == 0) { /* EOF */
2217718ced0SMaksim Yevmenkin log_debug("(fd#%d) EOF", fd);
2227718ced0SMaksim Yevmenkin packet_free(pkt);
2237718ced0SMaksim Yevmenkin channel_close(chan);
2247718ced0SMaksim Yevmenkin return;
2257718ced0SMaksim Yevmenkin }
2267718ced0SMaksim Yevmenkin pkt->len = nr;
2277718ced0SMaksim Yevmenkin
2287718ced0SMaksim Yevmenkin if (chan->recv(pkt) == true)
2297718ced0SMaksim Yevmenkin channel_dispatch(pkt);
2307718ced0SMaksim Yevmenkin
2317718ced0SMaksim Yevmenkin packet_free(pkt);
2327718ced0SMaksim Yevmenkin }
2337718ced0SMaksim Yevmenkin
2347718ced0SMaksim Yevmenkin static void
channel_dispatch(packet_t * pkt)2357718ced0SMaksim Yevmenkin channel_dispatch(packet_t *pkt)
2367718ced0SMaksim Yevmenkin {
2377718ced0SMaksim Yevmenkin channel_t *chan;
2387718ced0SMaksim Yevmenkin
2397718ced0SMaksim Yevmenkin /*
2407718ced0SMaksim Yevmenkin * This is simple routing. I'm not sure if its allowed by
2417718ced0SMaksim Yevmenkin * the PAN or BNEP specifications, but it seems logical
2427718ced0SMaksim Yevmenkin * to send unicast packets to connected destinations where
2437718ced0SMaksim Yevmenkin * possible.
2447718ced0SMaksim Yevmenkin */
2457718ced0SMaksim Yevmenkin if (!ETHER_IS_MULTICAST(pkt->dst)) {
2467718ced0SMaksim Yevmenkin LIST_FOREACH(chan, &channel_list, next) {
2477718ced0SMaksim Yevmenkin if (chan == pkt->chan
2487718ced0SMaksim Yevmenkin || chan->state != CHANNEL_OPEN)
2497718ced0SMaksim Yevmenkin continue;
2507718ced0SMaksim Yevmenkin
2517718ced0SMaksim Yevmenkin if (memcmp(pkt->dst, chan->raddr, ETHER_ADDR_LEN) == 0) {
2527718ced0SMaksim Yevmenkin if (chan->qlen > CHANNEL_MAXQLEN)
2537718ced0SMaksim Yevmenkin log_notice("Queue overflow");
2547718ced0SMaksim Yevmenkin else
2557718ced0SMaksim Yevmenkin channel_put(chan, pkt);
2567718ced0SMaksim Yevmenkin
2577718ced0SMaksim Yevmenkin return;
2587718ced0SMaksim Yevmenkin }
2597718ced0SMaksim Yevmenkin }
2607718ced0SMaksim Yevmenkin }
2617718ced0SMaksim Yevmenkin
2627718ced0SMaksim Yevmenkin LIST_FOREACH(chan, &channel_list, next) {
2637718ced0SMaksim Yevmenkin if (chan == pkt->chan
2647718ced0SMaksim Yevmenkin || chan->state != CHANNEL_OPEN)
2657718ced0SMaksim Yevmenkin continue;
2667718ced0SMaksim Yevmenkin
2677718ced0SMaksim Yevmenkin if (chan->qlen > CHANNEL_MAXQLEN) {
2687718ced0SMaksim Yevmenkin log_notice("Queue overflow");
2697718ced0SMaksim Yevmenkin continue;
2707718ced0SMaksim Yevmenkin }
2717718ced0SMaksim Yevmenkin
2727718ced0SMaksim Yevmenkin channel_put(chan, pkt);
2737718ced0SMaksim Yevmenkin }
2747718ced0SMaksim Yevmenkin }
2757718ced0SMaksim Yevmenkin
2767718ced0SMaksim Yevmenkin void
channel_put(channel_t * chan,packet_t * pkt)2777718ced0SMaksim Yevmenkin channel_put(channel_t *chan, packet_t *pkt)
2787718ced0SMaksim Yevmenkin {
2797718ced0SMaksim Yevmenkin pkthdr_t *ph;
2807718ced0SMaksim Yevmenkin
2817718ced0SMaksim Yevmenkin ph = pkthdr_alloc(pkt);
2827718ced0SMaksim Yevmenkin if (ph == NULL)
2837718ced0SMaksim Yevmenkin return;
2847718ced0SMaksim Yevmenkin
2857718ced0SMaksim Yevmenkin chan->qlen++;
2867718ced0SMaksim Yevmenkin STAILQ_INSERT_TAIL(&chan->pktlist, ph, next);
2877718ced0SMaksim Yevmenkin
2887718ced0SMaksim Yevmenkin if (!chan->oactive)
2897718ced0SMaksim Yevmenkin channel_start(chan->fd, EV_WRITE, chan);
2907718ced0SMaksim Yevmenkin }
2917718ced0SMaksim Yevmenkin
2927718ced0SMaksim Yevmenkin /*
2937718ced0SMaksim Yevmenkin * Simple watchdog timer, only ticks when it is required and
2947718ced0SMaksim Yevmenkin * closes the channel down if it times out.
2957718ced0SMaksim Yevmenkin */
2967718ced0SMaksim Yevmenkin void
channel_timeout(channel_t * chan,int to)2977718ced0SMaksim Yevmenkin channel_timeout(channel_t *chan, int to)
2987718ced0SMaksim Yevmenkin {
2997718ced0SMaksim Yevmenkin static struct event ev;
3007718ced0SMaksim Yevmenkin
3017718ced0SMaksim Yevmenkin if (to == 0)
3027718ced0SMaksim Yevmenkin chan->tick = 0;
3037718ced0SMaksim Yevmenkin else
3047718ced0SMaksim Yevmenkin chan->tick = (channel_tick + to) % 60;
3057718ced0SMaksim Yevmenkin
3067718ced0SMaksim Yevmenkin if (channel_tick == 0) {
3077718ced0SMaksim Yevmenkin evtimer_set(&ev, channel_watchdog, &ev);
3087718ced0SMaksim Yevmenkin channel_watchdog(0, 0, &ev);
3097718ced0SMaksim Yevmenkin }
3107718ced0SMaksim Yevmenkin }
3117718ced0SMaksim Yevmenkin
3127718ced0SMaksim Yevmenkin static void
channel_watchdog(int fd,short ev,void * arg)3137718ced0SMaksim Yevmenkin channel_watchdog(int fd, short ev, void *arg)
3147718ced0SMaksim Yevmenkin {
3157718ced0SMaksim Yevmenkin static struct timeval tv = { .tv_sec = 1 };
3167718ced0SMaksim Yevmenkin channel_t *chan, *next;
3177718ced0SMaksim Yevmenkin int tick;
3187718ced0SMaksim Yevmenkin
3197718ced0SMaksim Yevmenkin tick = (channel_tick % 60) + 1;
3207718ced0SMaksim Yevmenkin channel_tick = 0;
3217718ced0SMaksim Yevmenkin
3227718ced0SMaksim Yevmenkin next = LIST_FIRST(&channel_list);
3237718ced0SMaksim Yevmenkin while ((chan = next) != NULL) {
3247718ced0SMaksim Yevmenkin next = LIST_NEXT(chan, next);
3257718ced0SMaksim Yevmenkin
3267718ced0SMaksim Yevmenkin if (chan->tick == tick)
3277718ced0SMaksim Yevmenkin channel_close(chan);
3287718ced0SMaksim Yevmenkin else if (chan->tick != 0)
3297718ced0SMaksim Yevmenkin channel_tick = tick;
3307718ced0SMaksim Yevmenkin }
3317718ced0SMaksim Yevmenkin
3327718ced0SMaksim Yevmenkin if (channel_tick != 0 && evtimer_add(arg, &tv) < 0) {
3337718ced0SMaksim Yevmenkin log_err("Could not add watchdog event: %m");
3347718ced0SMaksim Yevmenkin exit(EXIT_FAILURE);
3357718ced0SMaksim Yevmenkin }
3367718ced0SMaksim Yevmenkin }
337