Path: blob/main/usr.sbin/bluetooth/bthidd/session.c
103072 views
/*1* session.c2*/34/*-5* SPDX-License-Identifier: BSD-2-Clause6*7* Copyright (c) 2006 Maksim Yevmenkin <[email protected]>8* All rights reserved.9*10* Redistribution and use in source and binary forms, with or without11* modification, are permitted provided that the following conditions12* are met:13* 1. Redistributions of source code must retain the above copyright14* notice, this list of conditions and the following disclaimer.15* 2. Redistributions in binary form must reproduce the above copyright16* notice, this list of conditions and the following disclaimer in the17* documentation and/or other materials provided with the distribution.18*19* THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND20* ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE21* IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE22* ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE23* FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL24* DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS25* OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)26* HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT27* LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY28* OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF29* SUCH DAMAGE.30*31* $Id: session.c,v 1.3 2006/09/07 21:06:53 max Exp $32*/3334#include <sys/queue.h>35#include <assert.h>36#define L2CAP_SOCKET_CHECKED37#include <bluetooth.h>38#include <errno.h>39#include <fcntl.h>40#include <stdio.h>41#include <stdlib.h>42#include <string.h>43#include <syslog.h>44#include <unistd.h>45#include <usbhid.h>46#include "bthid_config.h"47#include "bthidd.h"48#include "btuinput.h"49#include "kbd.h"5051/*52* Create new session53*/5455bthid_session_p56session_open(bthid_server_p srv, hid_device_p const d)57{58bthid_session_p s;5960assert(srv != NULL);61assert(d != NULL);6263if ((s = (bthid_session_p) malloc(sizeof(*s))) == NULL)64return (NULL);6566s->srv = srv;67memcpy(&s->bdaddr, &d->bdaddr, sizeof(s->bdaddr));68s->ctrl = -1;69s->intr = -1;70s->vkbd = -1;71s->ctx = NULL;72s->state = CLOSED;73s->ukbd = -1;74s->umouse = -1;75s->obutt = 0;7677s->keys1 = bit_alloc(kbd_maxkey());78if (s->keys1 == NULL) {79free(s);80return (NULL);81}8283s->keys2 = bit_alloc(kbd_maxkey());84if (s->keys2 == NULL) {85free(s->keys1);86free(s);87return (NULL);88}8990LIST_INSERT_HEAD(&srv->sessions, s, next);9192return (s);93}9495/*96* Initialize virtual keyboard and mouse after both channels are established97*/9899int32_t100session_run(bthid_session_p s)101{102hid_device_p d = get_hid_device(&s->bdaddr);103struct sockaddr_l2cap local;104socklen_t len;105106if (d->keyboard) {107/* Open /dev/vkbdctl */108s->vkbd = open("/dev/vkbdctl", O_RDWR);109if (s->vkbd < 0) {110syslog(LOG_ERR, "Could not open /dev/vkbdctl " \111"for %s. %s (%d)", bt_ntoa(&s->bdaddr, NULL),112strerror(errno), errno);113return (-1);114}115/* Register session's vkbd descriptor (if needed) for read */116FD_SET(s->vkbd, &s->srv->rfdset);117if (s->vkbd > s->srv->maxfd)118s->srv->maxfd = s->vkbd;119}120121/* Pass device for probing */122hid_initialise(s);123124/* Take local bdaddr */125len = sizeof(local);126getsockname(s->ctrl, (struct sockaddr *) &local, &len);127128if (d->mouse && s->srv->uinput) {129s->umouse = uinput_open_mouse(d, &local.l2cap_bdaddr);130if (s->umouse < 0) {131syslog(LOG_ERR, "Could not open /dev/uinput " \132"for %s. %s (%d)", bt_ntoa(&s->bdaddr,133NULL), strerror(errno), errno);134return (-1);135}136}137if (d->keyboard && s->srv->uinput) {138s->ukbd = uinput_open_keyboard(d, &local.l2cap_bdaddr);139if (s->ukbd < 0) {140syslog(LOG_ERR, "Could not open /dev/uinput " \141"for %s. %s (%d)", bt_ntoa(&s->bdaddr,142NULL), strerror(errno), errno);143return (-1);144}145/* Register session's ukbd descriptor (if needed) for read */146FD_SET(s->ukbd, &s->srv->rfdset);147if (s->ukbd > s->srv->maxfd)148s->srv->maxfd = s->ukbd;149}150return (0);151}152153/*154* Lookup session by bdaddr155*/156157bthid_session_p158session_by_bdaddr(bthid_server_p srv, bdaddr_p bdaddr)159{160bthid_session_p s;161162assert(srv != NULL);163assert(bdaddr != NULL);164165LIST_FOREACH(s, &srv->sessions, next)166if (memcmp(&s->bdaddr, bdaddr, sizeof(s->bdaddr)) == 0)167break;168169return (s);170}171172/*173* Lookup session by fd174*/175176bthid_session_p177session_by_fd(bthid_server_p srv, int32_t fd)178{179bthid_session_p s;180181assert(srv != NULL);182assert(fd >= 0);183184LIST_FOREACH(s, &srv->sessions, next)185if (s->ctrl == fd || s->intr == fd ||186s->vkbd == fd || s->ukbd == fd)187break;188189return (s);190}191192/*193* Close session194*/195196void197session_close(bthid_session_p s)198{199assert(s != NULL);200assert(s->srv != NULL);201202LIST_REMOVE(s, next);203204if (s->intr != -1) {205FD_CLR(s->intr, &s->srv->rfdset);206FD_CLR(s->intr, &s->srv->wfdset);207close(s->intr);208209if (s->srv->maxfd == s->intr)210s->srv->maxfd --;211}212213if (s->ctrl != -1) {214FD_CLR(s->ctrl, &s->srv->rfdset);215FD_CLR(s->ctrl, &s->srv->wfdset);216close(s->ctrl);217218if (s->srv->maxfd == s->ctrl)219s->srv->maxfd --;220}221222if (s->vkbd != -1) {223FD_CLR(s->vkbd, &s->srv->rfdset);224close(s->vkbd);225226if (s->srv->maxfd == s->vkbd)227s->srv->maxfd --;228}229230if (s->umouse != -1)231close(s->umouse);232233if (s->ukbd != -1) {234FD_CLR(s->ukbd, &s->srv->rfdset);235close(s->ukbd);236237if (s->srv->maxfd == s->ukbd)238s->srv->maxfd --;239}240241free(s->ctx);242free(s->keys1);243free(s->keys2);244245memset(s, 0, sizeof(*s));246free(s);247}248249250251