|
Packit Service |
8264ee |
/*
|
|
Packit Service |
8264ee |
*
|
|
Packit Service |
8264ee |
* BlueZ - Bluetooth protocol stack for Linux
|
|
Packit Service |
8264ee |
*
|
|
Packit Service |
8264ee |
* Copyright (C) 2004-2010 Marcel Holtmann <marcel@holtmann.org>
|
|
Packit Service |
8264ee |
* Copyright (C) 2014 Google Inc.
|
|
Packit Service |
8264ee |
*
|
|
Packit Service |
8264ee |
*
|
|
Packit Service |
8264ee |
* This program is free software; you can redistribute it and/or modify
|
|
Packit Service |
8264ee |
* it under the terms of the GNU General Public License as published by
|
|
Packit Service |
8264ee |
* the Free Software Foundation; either version 2 of the License, or
|
|
Packit Service |
8264ee |
* (at your option) any later version.
|
|
Packit Service |
8264ee |
*
|
|
Packit Service |
8264ee |
* This program is distributed in the hope that it will be useful,
|
|
Packit Service |
8264ee |
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
Packit Service |
8264ee |
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
|
Packit Service |
8264ee |
* GNU General Public License for more details.
|
|
Packit Service |
8264ee |
*
|
|
Packit Service |
8264ee |
* You should have received a copy of the GNU General Public License
|
|
Packit Service |
8264ee |
* along with this program; if not, write to the Free Software
|
|
Packit Service |
8264ee |
* Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA
|
|
Packit Service |
8264ee |
*
|
|
Packit Service |
8264ee |
*/
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
#ifdef HAVE_CONFIG_H
|
|
Packit Service |
8264ee |
#include <config.h>
|
|
Packit Service |
8264ee |
#endif
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
#define _GNU_SOURCE
|
|
Packit Service |
8264ee |
#include <stdlib.h>
|
|
Packit Service |
8264ee |
#include <stdbool.h>
|
|
Packit Service |
8264ee |
#include <errno.h>
|
|
Packit Service |
8264ee |
#include <fcntl.h>
|
|
Packit Service |
8264ee |
#include <unistd.h>
|
|
Packit Service |
8264ee |
#include <sys/ioctl.h>
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
#include "lib/bluetooth.h"
|
|
Packit Service |
8264ee |
#include "lib/hidp.h"
|
|
Packit Service |
8264ee |
#include "lib/sdp.h"
|
|
Packit Service |
8264ee |
#include "lib/sdp_lib.h"
|
|
Packit Service |
8264ee |
#include "lib/uuid.h"
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
#include "gdbus/gdbus.h"
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
#include "btio/btio.h"
|
|
Packit Service |
8264ee |
#include "src/log.h"
|
|
Packit Service |
8264ee |
#include "src/adapter.h"
|
|
Packit Service |
8264ee |
#include "src/device.h"
|
|
Packit Service |
8264ee |
#include "src/profile.h"
|
|
Packit Service |
8264ee |
#include "src/service.h"
|
|
Packit Service |
8264ee |
#include "src/storage.h"
|
|
Packit Service |
8264ee |
#include "src/dbus-common.h"
|
|
Packit Service |
8264ee |
#include "src/error.h"
|
|
Packit Service |
8264ee |
#include "src/sdp-client.h"
|
|
Packit Service |
8264ee |
#include "src/shared/uhid.h"
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
#include "device.h"
|
|
Packit Service |
8264ee |
#include "hidp_defs.h"
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
#define INPUT_INTERFACE "org.bluez.Input1"
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
enum reconnect_mode_t {
|
|
Packit Service |
8264ee |
RECONNECT_NONE = 0,
|
|
Packit Service |
8264ee |
RECONNECT_DEVICE,
|
|
Packit Service |
8264ee |
RECONNECT_HOST,
|
|
Packit Service |
8264ee |
RECONNECT_ANY
|
|
Packit Service |
8264ee |
};
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
struct input_device {
|
|
Packit Service |
8264ee |
struct btd_service *service;
|
|
Packit Service |
8264ee |
struct btd_device *device;
|
|
Packit Service |
8264ee |
char *path;
|
|
Packit Service |
8264ee |
bdaddr_t src;
|
|
Packit Service |
8264ee |
bdaddr_t dst;
|
|
Packit Service |
8264ee |
uint32_t handle;
|
|
Packit Service |
8264ee |
GIOChannel *ctrl_io;
|
|
Packit Service |
8264ee |
GIOChannel *intr_io;
|
|
Packit Service |
8264ee |
guint ctrl_watch;
|
|
Packit Service |
8264ee |
guint intr_watch;
|
|
Packit Service |
8264ee |
guint sec_watch;
|
|
Packit Service |
8264ee |
struct hidp_connadd_req *req;
|
|
Packit Service |
8264ee |
bool disable_sdp;
|
|
Packit Service |
8264ee |
enum reconnect_mode_t reconnect_mode;
|
|
Packit Service |
8264ee |
guint reconnect_timer;
|
|
Packit Service |
8264ee |
uint32_t reconnect_attempt;
|
|
Packit Service |
8264ee |
struct bt_uhid *uhid;
|
|
Packit Service |
8264ee |
bool uhid_created;
|
|
Packit Service |
8264ee |
uint8_t report_req_pending;
|
|
Packit Service |
8264ee |
guint report_req_timer;
|
|
Packit Service |
8264ee |
uint32_t report_rsp_id;
|
|
Packit Service |
8264ee |
};
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
static int idle_timeout = 0;
|
|
Packit Service |
8264ee |
static bool uhid_enabled = false;
|
|
rpm-build |
300f4b |
static bool classic_bonded_only = false;
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
void input_set_idle_timeout(int timeout)
|
|
Packit Service |
8264ee |
{
|
|
Packit Service |
8264ee |
idle_timeout = timeout;
|
|
Packit Service |
8264ee |
}
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
void input_enable_userspace_hid(bool state)
|
|
Packit Service |
8264ee |
{
|
|
Packit Service |
8264ee |
uhid_enabled = state;
|
|
Packit Service |
8264ee |
}
|
|
Packit Service |
8264ee |
|
|
rpm-build |
300f4b |
void input_set_classic_bonded_only(bool state)
|
|
rpm-build |
300f4b |
{
|
|
rpm-build |
300f4b |
classic_bonded_only = state;
|
|
rpm-build |
300f4b |
}
|
|
rpm-build |
300f4b |
|
|
Packit Service |
8264ee |
static void input_device_enter_reconnect_mode(struct input_device *idev);
|
|
Packit Service |
8264ee |
static int connection_disconnect(struct input_device *idev, uint32_t flags);
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
static void input_device_free(struct input_device *idev)
|
|
Packit Service |
8264ee |
{
|
|
Packit Service |
8264ee |
bt_uhid_unref(idev->uhid);
|
|
Packit Service |
8264ee |
btd_service_unref(idev->service);
|
|
Packit Service |
8264ee |
btd_device_unref(idev->device);
|
|
Packit Service |
8264ee |
g_free(idev->path);
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
if (idev->ctrl_watch > 0)
|
|
Packit Service |
8264ee |
g_source_remove(idev->ctrl_watch);
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
if (idev->intr_watch > 0)
|
|
Packit Service |
8264ee |
g_source_remove(idev->intr_watch);
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
if (idev->sec_watch > 0)
|
|
Packit Service |
8264ee |
g_source_remove(idev->sec_watch);
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
if (idev->intr_io)
|
|
Packit Service |
8264ee |
g_io_channel_unref(idev->intr_io);
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
if (idev->ctrl_io)
|
|
Packit Service |
8264ee |
g_io_channel_unref(idev->ctrl_io);
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
if (idev->req) {
|
|
Packit Service |
8264ee |
g_free(idev->req->rd_data);
|
|
Packit Service |
8264ee |
g_free(idev->req);
|
|
Packit Service |
8264ee |
}
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
if (idev->reconnect_timer > 0)
|
|
Packit Service |
8264ee |
g_source_remove(idev->reconnect_timer);
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
if (idev->report_req_timer > 0)
|
|
Packit Service |
8264ee |
g_source_remove(idev->report_req_timer);
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
g_free(idev);
|
|
Packit Service |
8264ee |
}
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
static bool hidp_send_message(GIOChannel *chan, uint8_t hdr,
|
|
Packit Service |
8264ee |
const uint8_t *data, size_t size)
|
|
Packit Service |
8264ee |
{
|
|
Packit Service |
8264ee |
int fd;
|
|
Packit Service |
8264ee |
ssize_t len;
|
|
Packit Service |
8264ee |
uint8_t msg[size + 1];
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
if (!chan) {
|
|
Packit Service |
8264ee |
error("BT socket not connected");
|
|
Packit Service |
8264ee |
return false;
|
|
Packit Service |
8264ee |
}
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
if (data == NULL)
|
|
Packit Service |
8264ee |
size = 0;
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
msg[0] = hdr;
|
|
Packit Service |
8264ee |
if (size > 0)
|
|
Packit Service |
8264ee |
memcpy(&msg[1], data, size);
|
|
Packit Service |
8264ee |
++size;
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
fd = g_io_channel_unix_get_fd(chan);
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
len = write(fd, msg, size);
|
|
Packit Service |
8264ee |
if (len < 0) {
|
|
Packit Service |
8264ee |
error("BT socket write error: %s (%d)", strerror(errno), errno);
|
|
Packit Service |
8264ee |
return false;
|
|
Packit Service |
8264ee |
}
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
if ((size_t) len < size) {
|
|
Packit Service |
8264ee |
error("BT socket write error: partial write (%zd of %zu bytes)",
|
|
Packit Service |
8264ee |
len, size);
|
|
Packit Service |
8264ee |
return false;
|
|
Packit Service |
8264ee |
}
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
return true;
|
|
Packit Service |
8264ee |
}
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
static bool hidp_send_ctrl_message(struct input_device *idev, uint8_t hdr,
|
|
Packit Service |
8264ee |
const uint8_t *data, size_t size)
|
|
Packit Service |
8264ee |
{
|
|
Packit Service |
8264ee |
return hidp_send_message(idev->ctrl_io, hdr, data, size);
|
|
Packit Service |
8264ee |
}
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
static bool hidp_send_intr_message(struct input_device *idev, uint8_t hdr,
|
|
Packit Service |
8264ee |
const uint8_t *data, size_t size)
|
|
Packit Service |
8264ee |
{
|
|
Packit Service |
8264ee |
return hidp_send_message(idev->intr_io, hdr, data, size);
|
|
Packit Service |
8264ee |
}
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
static bool uhid_send_feature_answer(struct input_device *idev,
|
|
Packit Service |
8264ee |
const uint8_t *data, size_t size,
|
|
Packit Service |
8264ee |
uint32_t id, uint16_t err)
|
|
Packit Service |
8264ee |
{
|
|
Packit Service |
8264ee |
struct uhid_event ev;
|
|
Packit Service |
8264ee |
int ret;
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
if (data == NULL)
|
|
Packit Service |
8264ee |
size = 0;
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
if (size > sizeof(ev.u.feature_answer.data))
|
|
Packit Service |
8264ee |
size = sizeof(ev.u.feature_answer.data);
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
if (!idev->uhid_created) {
|
|
Packit Service |
8264ee |
DBG("HID report (%zu bytes) dropped", size);
|
|
Packit Service |
8264ee |
return false;
|
|
Packit Service |
8264ee |
}
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
memset(&ev, 0, sizeof(ev));
|
|
Packit Service |
8264ee |
ev.type = UHID_FEATURE_ANSWER;
|
|
Packit Service |
8264ee |
ev.u.feature_answer.id = id;
|
|
Packit Service |
8264ee |
ev.u.feature_answer.err = err;
|
|
Packit Service |
8264ee |
ev.u.feature_answer.size = size;
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
if (size > 0)
|
|
Packit Service |
8264ee |
memcpy(ev.u.feature_answer.data, data, size);
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
ret = bt_uhid_send(idev->uhid, &ev;;
|
|
Packit Service |
8264ee |
if (ret < 0) {
|
|
Packit Service |
8264ee |
error("bt_uhid_send: %s (%d)", strerror(-ret), -ret);
|
|
Packit Service |
8264ee |
return false;
|
|
Packit Service |
8264ee |
}
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
DBG("HID report (%zu bytes)", size);
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
return true;
|
|
Packit Service |
8264ee |
}
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
static bool uhid_send_input_report(struct input_device *idev,
|
|
Packit Service |
8264ee |
const uint8_t *data, size_t size)
|
|
Packit Service |
8264ee |
{
|
|
Packit Service |
8264ee |
struct uhid_event ev;
|
|
Packit Service |
8264ee |
int err;
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
if (data == NULL)
|
|
Packit Service |
8264ee |
size = 0;
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
if (size > sizeof(ev.u.input.data))
|
|
Packit Service |
8264ee |
size = sizeof(ev.u.input.data);
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
if (!idev->uhid_created) {
|
|
Packit Service |
8264ee |
DBG("HID report (%zu bytes) dropped", size);
|
|
Packit Service |
8264ee |
return false;
|
|
Packit Service |
8264ee |
}
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
memset(&ev, 0, sizeof(ev));
|
|
Packit Service |
8264ee |
ev.type = UHID_INPUT;
|
|
Packit Service |
8264ee |
ev.u.input.size = size;
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
if (size > 0)
|
|
Packit Service |
8264ee |
memcpy(ev.u.input.data, data, size);
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
err = bt_uhid_send(idev->uhid, &ev;;
|
|
Packit Service |
8264ee |
if (err < 0) {
|
|
Packit Service |
8264ee |
error("bt_uhid_send: %s (%d)", strerror(-err), -err);
|
|
Packit Service |
8264ee |
return false;
|
|
Packit Service |
8264ee |
}
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
DBG("HID report (%zu bytes)", size);
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
return true;
|
|
Packit Service |
8264ee |
}
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
static bool hidp_recv_intr_data(GIOChannel *chan, struct input_device *idev)
|
|
Packit Service |
8264ee |
{
|
|
Packit Service |
8264ee |
int fd;
|
|
Packit Service |
8264ee |
ssize_t len;
|
|
Packit Service |
8264ee |
uint8_t hdr;
|
|
Packit Service |
8264ee |
uint8_t data[UHID_DATA_MAX + 1];
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
fd = g_io_channel_unix_get_fd(chan);
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
len = read(fd, data, sizeof(data));
|
|
Packit Service |
8264ee |
if (len < 0) {
|
|
Packit Service |
8264ee |
error("BT socket read error: %s (%d)", strerror(errno), errno);
|
|
Packit Service |
8264ee |
return false;
|
|
Packit Service |
8264ee |
}
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
if (len == 0) {
|
|
Packit Service |
8264ee |
DBG("BT socket read returned 0 bytes");
|
|
Packit Service |
8264ee |
return true;
|
|
Packit Service |
8264ee |
}
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
hdr = data[0];
|
|
Packit Service |
8264ee |
if (hdr != (HIDP_TRANS_DATA | HIDP_DATA_RTYPE_INPUT)) {
|
|
Packit Service |
8264ee |
DBG("unsupported HIDP protocol header 0x%02x", hdr);
|
|
Packit Service |
8264ee |
return true;
|
|
Packit Service |
8264ee |
}
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
if (len < 2) {
|
|
Packit Service |
8264ee |
DBG("received empty HID report");
|
|
Packit Service |
8264ee |
return true;
|
|
Packit Service |
8264ee |
}
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
uhid_send_input_report(idev, data + 1, len - 1);
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
return true;
|
|
Packit Service |
8264ee |
}
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
static gboolean intr_watch_cb(GIOChannel *chan, GIOCondition cond, gpointer data)
|
|
Packit Service |
8264ee |
{
|
|
Packit Service |
8264ee |
struct input_device *idev = data;
|
|
Packit Service |
8264ee |
char address[18];
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
if (cond & G_IO_IN) {
|
|
Packit Service |
8264ee |
if (hidp_recv_intr_data(chan, idev) && (cond == G_IO_IN))
|
|
Packit Service |
8264ee |
return TRUE;
|
|
Packit Service |
8264ee |
}
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
ba2str(&idev->dst, address);
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
DBG("Device %s disconnected", address);
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
/* Checking for ctrl_watch avoids a double g_io_channel_shutdown since
|
|
Packit Service |
8264ee |
* it's likely that ctrl_watch_cb has been queued for dispatching in
|
|
Packit Service |
8264ee |
* this mainloop iteration */
|
|
Packit Service |
8264ee |
if ((cond & (G_IO_HUP | G_IO_ERR)) && idev->ctrl_watch)
|
|
Packit Service |
8264ee |
g_io_channel_shutdown(chan, TRUE, NULL);
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
idev->intr_watch = 0;
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
if (idev->intr_io) {
|
|
Packit Service |
8264ee |
g_io_channel_unref(idev->intr_io);
|
|
Packit Service |
8264ee |
idev->intr_io = NULL;
|
|
Packit Service |
8264ee |
}
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
/* Close control channel */
|
|
Packit Service |
8264ee |
if (idev->ctrl_io && !(cond & G_IO_NVAL))
|
|
Packit Service |
8264ee |
g_io_channel_shutdown(idev->ctrl_io, TRUE, NULL);
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
btd_service_disconnecting_complete(idev->service, 0);
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
/* Enter the auto-reconnect mode if needed */
|
|
Packit Service |
8264ee |
input_device_enter_reconnect_mode(idev);
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
return FALSE;
|
|
Packit Service |
8264ee |
}
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
static void hidp_recv_ctrl_handshake(struct input_device *idev, uint8_t param)
|
|
Packit Service |
8264ee |
{
|
|
Packit Service |
8264ee |
bool pending_req_complete = false;
|
|
Packit Service |
8264ee |
uint8_t pending_req_type;
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
DBG("");
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
pending_req_type = idev->report_req_pending & HIDP_HEADER_TRANS_MASK;
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
switch (param) {
|
|
Packit Service |
8264ee |
case HIDP_HSHK_SUCCESSFUL:
|
|
Packit Service |
8264ee |
if (pending_req_type == HIDP_TRANS_SET_REPORT) {
|
|
Packit Service |
8264ee |
DBG("SET_REPORT successful");
|
|
Packit Service |
8264ee |
pending_req_complete = true;
|
|
Packit Service |
8264ee |
} else
|
|
Packit Service |
8264ee |
DBG("Spurious HIDP_HSHK_SUCCESSFUL");
|
|
Packit Service |
8264ee |
break;
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
case HIDP_HSHK_NOT_READY:
|
|
Packit Service |
8264ee |
case HIDP_HSHK_ERR_INVALID_REPORT_ID:
|
|
Packit Service |
8264ee |
case HIDP_HSHK_ERR_UNSUPPORTED_REQUEST:
|
|
Packit Service |
8264ee |
case HIDP_HSHK_ERR_INVALID_PARAMETER:
|
|
Packit Service |
8264ee |
case HIDP_HSHK_ERR_UNKNOWN:
|
|
Packit Service |
8264ee |
case HIDP_HSHK_ERR_FATAL:
|
|
Packit Service |
8264ee |
if (pending_req_type == HIDP_TRANS_GET_REPORT) {
|
|
Packit Service |
8264ee |
DBG("GET_REPORT failed (%u)", param);
|
|
Packit Service |
8264ee |
uhid_send_feature_answer(idev, NULL, 0,
|
|
Packit Service |
8264ee |
idev->report_rsp_id, EIO);
|
|
Packit Service |
8264ee |
pending_req_complete = true;
|
|
Packit Service |
8264ee |
} else if (pending_req_type == HIDP_TRANS_SET_REPORT) {
|
|
Packit Service |
8264ee |
DBG("SET_REPORT failed (%u)", param);
|
|
Packit Service |
8264ee |
pending_req_complete = true;
|
|
Packit Service |
8264ee |
} else
|
|
Packit Service |
8264ee |
DBG("Spurious HIDP_HSHK_ERR");
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
if (param == HIDP_HSHK_ERR_FATAL)
|
|
Packit Service |
8264ee |
hidp_send_ctrl_message(idev, HIDP_TRANS_HID_CONTROL |
|
|
Packit Service |
8264ee |
HIDP_CTRL_SOFT_RESET, NULL, 0);
|
|
Packit Service |
8264ee |
break;
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
default:
|
|
Packit Service |
8264ee |
hidp_send_ctrl_message(idev, HIDP_TRANS_HANDSHAKE |
|
|
Packit Service |
8264ee |
HIDP_HSHK_ERR_INVALID_PARAMETER, NULL, 0);
|
|
Packit Service |
8264ee |
break;
|
|
Packit Service |
8264ee |
}
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
if (pending_req_complete) {
|
|
Packit Service |
8264ee |
idev->report_req_pending = 0;
|
|
Packit Service |
8264ee |
if (idev->report_req_timer > 0) {
|
|
Packit Service |
8264ee |
g_source_remove(idev->report_req_timer);
|
|
Packit Service |
8264ee |
idev->report_req_timer = 0;
|
|
Packit Service |
8264ee |
}
|
|
Packit Service |
8264ee |
idev->report_rsp_id = 0;
|
|
Packit Service |
8264ee |
}
|
|
Packit Service |
8264ee |
}
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
static void hidp_recv_ctrl_hid_control(struct input_device *idev, uint8_t param)
|
|
Packit Service |
8264ee |
{
|
|
Packit Service |
8264ee |
DBG("");
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
if (param == HIDP_CTRL_VIRTUAL_CABLE_UNPLUG)
|
|
Packit Service |
8264ee |
connection_disconnect(idev, 0);
|
|
Packit Service |
8264ee |
}
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
static void hidp_recv_ctrl_data(struct input_device *idev, uint8_t param,
|
|
Packit Service |
8264ee |
const uint8_t *data, size_t size)
|
|
Packit Service |
8264ee |
{
|
|
Packit Service |
8264ee |
uint8_t pending_req_type;
|
|
Packit Service |
8264ee |
uint8_t pending_req_param;
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
DBG("");
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
pending_req_type = idev->report_req_pending & HIDP_HEADER_TRANS_MASK;
|
|
Packit Service |
8264ee |
if (pending_req_type != HIDP_TRANS_GET_REPORT) {
|
|
Packit Service |
8264ee |
DBG("Spurious DATA on control channel");
|
|
Packit Service |
8264ee |
return;
|
|
Packit Service |
8264ee |
}
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
pending_req_param = idev->report_req_pending & HIDP_HEADER_PARAM_MASK;
|
|
Packit Service |
8264ee |
if (pending_req_param != param) {
|
|
Packit Service |
8264ee |
DBG("Received DATA RTYPE doesn't match pending request RTYPE");
|
|
Packit Service |
8264ee |
return;
|
|
Packit Service |
8264ee |
}
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
switch (param) {
|
|
Packit Service |
8264ee |
case HIDP_DATA_RTYPE_FEATURE:
|
|
Packit Service |
8264ee |
case HIDP_DATA_RTYPE_INPUT:
|
|
Packit Service |
8264ee |
case HIDP_DATA_RTYPE_OUPUT:
|
|
Packit Service |
8264ee |
uhid_send_feature_answer(idev, data + 1, size - 1,
|
|
Packit Service |
8264ee |
idev->report_rsp_id, 0);
|
|
Packit Service |
8264ee |
break;
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
case HIDP_DATA_RTYPE_OTHER:
|
|
Packit Service |
8264ee |
DBG("Received DATA_RTYPE_OTHER");
|
|
Packit Service |
8264ee |
break;
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
default:
|
|
Packit Service |
8264ee |
hidp_send_ctrl_message(idev, HIDP_TRANS_HANDSHAKE |
|
|
Packit Service |
8264ee |
HIDP_HSHK_ERR_INVALID_PARAMETER, NULL, 0);
|
|
Packit Service |
8264ee |
break;
|
|
Packit Service |
8264ee |
}
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
idev->report_req_pending = 0;
|
|
Packit Service |
8264ee |
if (idev->report_req_timer > 0) {
|
|
Packit Service |
8264ee |
g_source_remove(idev->report_req_timer);
|
|
Packit Service |
8264ee |
idev->report_req_timer = 0;
|
|
Packit Service |
8264ee |
}
|
|
Packit Service |
8264ee |
idev->report_rsp_id = 0;
|
|
Packit Service |
8264ee |
}
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
static bool hidp_recv_ctrl_message(GIOChannel *chan, struct input_device *idev)
|
|
Packit Service |
8264ee |
{
|
|
Packit Service |
8264ee |
int fd;
|
|
Packit Service |
8264ee |
ssize_t len;
|
|
Packit Service |
8264ee |
uint8_t hdr, type, param;
|
|
Packit Service |
8264ee |
uint8_t data[UHID_DATA_MAX + 1];
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
fd = g_io_channel_unix_get_fd(chan);
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
len = read(fd, data, sizeof(data));
|
|
Packit Service |
8264ee |
if (len < 0) {
|
|
Packit Service |
8264ee |
error("BT socket read error: %s (%d)", strerror(errno), errno);
|
|
Packit Service |
8264ee |
return false;
|
|
Packit Service |
8264ee |
}
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
if (len == 0) {
|
|
Packit Service |
8264ee |
DBG("BT socket read returned 0 bytes");
|
|
Packit Service |
8264ee |
return true;
|
|
Packit Service |
8264ee |
}
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
hdr = data[0];
|
|
Packit Service |
8264ee |
type = hdr & HIDP_HEADER_TRANS_MASK;
|
|
Packit Service |
8264ee |
param = hdr & HIDP_HEADER_PARAM_MASK;
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
switch (type) {
|
|
Packit Service |
8264ee |
case HIDP_TRANS_HANDSHAKE:
|
|
Packit Service |
8264ee |
hidp_recv_ctrl_handshake(idev, param);
|
|
Packit Service |
8264ee |
break;
|
|
Packit Service |
8264ee |
case HIDP_TRANS_HID_CONTROL:
|
|
Packit Service |
8264ee |
hidp_recv_ctrl_hid_control(idev, param);
|
|
Packit Service |
8264ee |
break;
|
|
Packit Service |
8264ee |
case HIDP_TRANS_DATA:
|
|
Packit Service |
8264ee |
hidp_recv_ctrl_data(idev, param, data, len);
|
|
Packit Service |
8264ee |
break;
|
|
Packit Service |
8264ee |
default:
|
|
Packit Service |
8264ee |
error("unsupported HIDP control message");
|
|
Packit Service |
8264ee |
hidp_send_ctrl_message(idev, HIDP_TRANS_HANDSHAKE |
|
|
Packit Service |
8264ee |
HIDP_HSHK_ERR_UNSUPPORTED_REQUEST, NULL, 0);
|
|
Packit Service |
8264ee |
break;
|
|
Packit Service |
8264ee |
}
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
return true;
|
|
Packit Service |
8264ee |
}
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
static gboolean ctrl_watch_cb(GIOChannel *chan, GIOCondition cond, gpointer data)
|
|
Packit Service |
8264ee |
{
|
|
Packit Service |
8264ee |
struct input_device *idev = data;
|
|
Packit Service |
8264ee |
char address[18];
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
if (cond & G_IO_IN) {
|
|
Packit Service |
8264ee |
if (hidp_recv_ctrl_message(chan, idev) && (cond == G_IO_IN))
|
|
Packit Service |
8264ee |
return TRUE;
|
|
Packit Service |
8264ee |
}
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
ba2str(&idev->dst, address);
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
DBG("Device %s disconnected", address);
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
/* Checking for intr_watch avoids a double g_io_channel_shutdown since
|
|
Packit Service |
8264ee |
* it's likely that intr_watch_cb has been queued for dispatching in
|
|
Packit Service |
8264ee |
* this mainloop iteration */
|
|
Packit Service |
8264ee |
if ((cond & (G_IO_HUP | G_IO_ERR)) && idev->intr_watch)
|
|
Packit Service |
8264ee |
g_io_channel_shutdown(chan, TRUE, NULL);
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
idev->ctrl_watch = 0;
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
if (idev->ctrl_io) {
|
|
Packit Service |
8264ee |
g_io_channel_unref(idev->ctrl_io);
|
|
Packit Service |
8264ee |
idev->ctrl_io = NULL;
|
|
Packit Service |
8264ee |
}
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
/* Close interrupt channel */
|
|
Packit Service |
8264ee |
if (idev->intr_io && !(cond & G_IO_NVAL))
|
|
Packit Service |
8264ee |
g_io_channel_shutdown(idev->intr_io, TRUE, NULL);
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
return FALSE;
|
|
Packit Service |
8264ee |
}
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
#define REPORT_REQ_TIMEOUT 3
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
static gboolean hidp_report_req_timeout(gpointer data)
|
|
Packit Service |
8264ee |
{
|
|
Packit Service |
8264ee |
struct input_device *idev = data;
|
|
Packit Service |
8264ee |
uint8_t pending_req_type;
|
|
Packit Service |
8264ee |
const char *req_type_str;
|
|
Packit Service |
8264ee |
char address[18];
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
ba2str(&idev->dst, address);
|
|
Packit Service |
8264ee |
pending_req_type = idev->report_req_pending & HIDP_HEADER_TRANS_MASK;
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
switch (pending_req_type) {
|
|
Packit Service |
8264ee |
case HIDP_TRANS_GET_REPORT:
|
|
Packit Service |
8264ee |
req_type_str = "GET_REPORT";
|
|
Packit Service |
8264ee |
break;
|
|
Packit Service |
8264ee |
case HIDP_TRANS_SET_REPORT:
|
|
Packit Service |
8264ee |
req_type_str = "SET_REPORT";
|
|
Packit Service |
8264ee |
break;
|
|
Packit Service |
8264ee |
default:
|
|
Packit Service |
8264ee |
/* Should never happen */
|
|
Packit Service |
8264ee |
req_type_str = "OTHER_TRANS";
|
|
Packit Service |
8264ee |
break;
|
|
Packit Service |
8264ee |
}
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
DBG("Device %s HIDP %s request timed out", address, req_type_str);
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
idev->report_req_pending = 0;
|
|
Packit Service |
8264ee |
idev->report_req_timer = 0;
|
|
Packit Service |
8264ee |
idev->report_rsp_id = 0;
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
return FALSE;
|
|
Packit Service |
8264ee |
}
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
static void hidp_send_set_report(struct uhid_event *ev, void *user_data)
|
|
Packit Service |
8264ee |
{
|
|
Packit Service |
8264ee |
struct input_device *idev = user_data;
|
|
Packit Service |
8264ee |
uint8_t hdr;
|
|
Packit Service |
8264ee |
bool sent;
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
DBG("");
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
switch (ev->u.output.rtype) {
|
|
Packit Service |
8264ee |
case UHID_FEATURE_REPORT:
|
|
Packit Service |
8264ee |
/* Send SET_REPORT on control channel */
|
|
Packit Service |
8264ee |
if (idev->report_req_pending) {
|
|
Packit Service |
8264ee |
DBG("Old GET_REPORT or SET_REPORT still pending");
|
|
Packit Service |
8264ee |
return;
|
|
Packit Service |
8264ee |
}
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
hdr = HIDP_TRANS_SET_REPORT | HIDP_DATA_RTYPE_FEATURE;
|
|
Packit Service |
8264ee |
sent = hidp_send_ctrl_message(idev, hdr, ev->u.output.data,
|
|
Packit Service |
8264ee |
ev->u.output.size);
|
|
Packit Service |
8264ee |
if (sent) {
|
|
Packit Service |
8264ee |
idev->report_req_pending = hdr;
|
|
Packit Service |
8264ee |
idev->report_req_timer =
|
|
Packit Service |
8264ee |
g_timeout_add_seconds(REPORT_REQ_TIMEOUT,
|
|
Packit Service |
8264ee |
hidp_report_req_timeout, idev);
|
|
Packit Service |
8264ee |
}
|
|
Packit Service |
8264ee |
break;
|
|
Packit Service |
8264ee |
case UHID_OUTPUT_REPORT:
|
|
Packit Service |
8264ee |
/* Send DATA on interrupt channel */
|
|
Packit Service |
8264ee |
hdr = HIDP_TRANS_DATA | HIDP_DATA_RTYPE_OUPUT;
|
|
Packit Service |
8264ee |
hidp_send_intr_message(idev, hdr, ev->u.output.data,
|
|
Packit Service |
8264ee |
ev->u.output.size);
|
|
Packit Service |
8264ee |
break;
|
|
Packit Service |
8264ee |
default:
|
|
Packit Service |
8264ee |
DBG("Unsupported HID report type %u", ev->u.output.rtype);
|
|
Packit Service |
8264ee |
return;
|
|
Packit Service |
8264ee |
}
|
|
Packit Service |
8264ee |
}
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
static void hidp_send_get_report(struct uhid_event *ev, void *user_data)
|
|
Packit Service |
8264ee |
{
|
|
Packit Service |
8264ee |
struct input_device *idev = user_data;
|
|
Packit Service |
8264ee |
uint8_t hdr;
|
|
Packit Service |
8264ee |
bool sent;
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
DBG("");
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
if (idev->report_req_pending) {
|
|
Packit Service |
8264ee |
DBG("Old GET_REPORT or SET_REPORT still pending");
|
|
Packit Service |
8264ee |
uhid_send_feature_answer(idev, NULL, 0, ev->u.feature.id,
|
|
Packit Service |
8264ee |
EBUSY);
|
|
Packit Service |
8264ee |
return;
|
|
Packit Service |
8264ee |
}
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
/* Send GET_REPORT on control channel */
|
|
Packit Service |
8264ee |
switch (ev->u.feature.rtype) {
|
|
Packit Service |
8264ee |
case UHID_FEATURE_REPORT:
|
|
Packit Service |
8264ee |
hdr = HIDP_TRANS_GET_REPORT | HIDP_DATA_RTYPE_FEATURE;
|
|
Packit Service |
8264ee |
break;
|
|
Packit Service |
8264ee |
case UHID_INPUT_REPORT:
|
|
Packit Service |
8264ee |
hdr = HIDP_TRANS_GET_REPORT | HIDP_DATA_RTYPE_INPUT;
|
|
Packit Service |
8264ee |
break;
|
|
Packit Service |
8264ee |
case UHID_OUTPUT_REPORT:
|
|
Packit Service |
8264ee |
hdr = HIDP_TRANS_GET_REPORT | HIDP_DATA_RTYPE_OUPUT;
|
|
Packit Service |
8264ee |
break;
|
|
Packit Service |
8264ee |
default:
|
|
Packit Service |
8264ee |
DBG("Unsupported HID report type %u", ev->u.feature.rtype);
|
|
Packit Service |
8264ee |
return;
|
|
Packit Service |
8264ee |
}
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
sent = hidp_send_ctrl_message(idev, hdr, &ev->u.feature.rnum,
|
|
Packit Service |
8264ee |
sizeof(ev->u.feature.rnum));
|
|
Packit Service |
8264ee |
if (sent) {
|
|
Packit Service |
8264ee |
idev->report_req_pending = hdr;
|
|
Packit Service |
8264ee |
idev->report_req_timer =
|
|
Packit Service |
8264ee |
g_timeout_add_seconds(REPORT_REQ_TIMEOUT,
|
|
Packit Service |
8264ee |
hidp_report_req_timeout, idev);
|
|
Packit Service |
8264ee |
idev->report_rsp_id = ev->u.feature.id;
|
|
Packit Service |
8264ee |
}
|
|
Packit Service |
8264ee |
}
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
static void epox_endian_quirk(unsigned char *data, int size)
|
|
Packit Service |
8264ee |
{
|
|
Packit Service |
8264ee |
/* USAGE_PAGE (Keyboard) 05 07
|
|
Packit Service |
8264ee |
* USAGE_MINIMUM (0) 19 00
|
|
Packit Service |
8264ee |
* USAGE_MAXIMUM (65280) 2A 00 FF <= must be FF 00
|
|
Packit Service |
8264ee |
* LOGICAL_MINIMUM (0) 15 00
|
|
Packit Service |
8264ee |
* LOGICAL_MAXIMUM (65280) 26 00 FF <= must be FF 00
|
|
Packit Service |
8264ee |
*/
|
|
Packit Service |
8264ee |
unsigned char pattern[] = { 0x05, 0x07, 0x19, 0x00, 0x2a, 0x00, 0xff,
|
|
Packit Service |
8264ee |
0x15, 0x00, 0x26, 0x00, 0xff };
|
|
Packit Service |
8264ee |
unsigned int i;
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
if (!data)
|
|
Packit Service |
8264ee |
return;
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
for (i = 0; i < size - sizeof(pattern); i++) {
|
|
Packit Service |
8264ee |
if (!memcmp(data + i, pattern, sizeof(pattern))) {
|
|
Packit Service |
8264ee |
data[i + 5] = 0xff;
|
|
Packit Service |
8264ee |
data[i + 6] = 0x00;
|
|
Packit Service |
8264ee |
data[i + 10] = 0xff;
|
|
Packit Service |
8264ee |
data[i + 11] = 0x00;
|
|
Packit Service |
8264ee |
}
|
|
Packit Service |
8264ee |
}
|
|
Packit Service |
8264ee |
}
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
static int create_hid_dev_name(sdp_record_t *rec, struct hidp_connadd_req *req)
|
|
Packit Service |
8264ee |
{
|
|
Packit Service |
8264ee |
char sdesc[sizeof(req->name) / 2];
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
if (sdp_get_service_desc(rec, sdesc, sizeof(sdesc)) == 0) {
|
|
Packit Service |
8264ee |
char pname[sizeof(req->name) / 2];
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
if (sdp_get_provider_name(rec, pname, sizeof(pname)) == 0 &&
|
|
Packit Service |
8264ee |
strncmp(sdesc, pname, 5) != 0)
|
|
Packit Service |
8264ee |
snprintf(req->name, sizeof(req->name), "%s %s",
|
|
Packit Service |
8264ee |
pname, sdesc);
|
|
Packit Service |
8264ee |
else
|
|
Packit Service |
8264ee |
snprintf(req->name, sizeof(req->name), "%s", sdesc);
|
|
Packit Service |
8264ee |
} else {
|
|
Packit Service |
8264ee |
return sdp_get_service_name(rec, req->name, sizeof(req->name));
|
|
Packit Service |
8264ee |
}
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
return 0;
|
|
Packit Service |
8264ee |
}
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
/* See HID profile specification v1.0, "7.11.6 HIDDescriptorList" for details
|
|
Packit Service |
8264ee |
* on the attribute format. */
|
|
Packit Service |
8264ee |
static int extract_hid_desc_data(sdp_record_t *rec,
|
|
Packit Service |
8264ee |
struct hidp_connadd_req *req)
|
|
Packit Service |
8264ee |
{
|
|
Packit Service |
8264ee |
sdp_data_t *d;
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
d = sdp_data_get(rec, SDP_ATTR_HID_DESCRIPTOR_LIST);
|
|
Packit Service |
8264ee |
if (!d)
|
|
Packit Service |
8264ee |
goto invalid_desc;
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
if (!SDP_IS_SEQ(d->dtd))
|
|
Packit Service |
8264ee |
goto invalid_desc;
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
/* First HIDDescriptor */
|
|
Packit Service |
8264ee |
d = d->val.dataseq;
|
|
Packit Service |
8264ee |
if (!SDP_IS_SEQ(d->dtd))
|
|
Packit Service |
8264ee |
goto invalid_desc;
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
/* ClassDescriptorType */
|
|
Packit Service |
8264ee |
d = d->val.dataseq;
|
|
Packit Service |
8264ee |
if (d->dtd != SDP_UINT8)
|
|
Packit Service |
8264ee |
goto invalid_desc;
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
/* ClassDescriptorData */
|
|
Packit Service |
8264ee |
d = d->next;
|
|
Packit Service |
8264ee |
if (!d || !SDP_IS_TEXT_STR(d->dtd))
|
|
Packit Service |
8264ee |
goto invalid_desc;
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
req->rd_data = g_try_malloc0(d->unitSize);
|
|
Packit Service |
8264ee |
if (req->rd_data) {
|
|
Packit Service |
8264ee |
memcpy(req->rd_data, d->val.str, d->unitSize);
|
|
Packit Service |
8264ee |
req->rd_size = d->unitSize;
|
|
Packit Service |
8264ee |
epox_endian_quirk(req->rd_data, req->rd_size);
|
|
Packit Service |
8264ee |
}
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
return 0;
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
invalid_desc:
|
|
Packit Service |
8264ee |
error("Missing or invalid HIDDescriptorList SDP attribute");
|
|
Packit Service |
8264ee |
return -EINVAL;
|
|
Packit Service |
8264ee |
}
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
static int extract_hid_record(sdp_record_t *rec, struct hidp_connadd_req *req)
|
|
Packit Service |
8264ee |
{
|
|
Packit Service |
8264ee |
sdp_data_t *pdlist;
|
|
Packit Service |
8264ee |
uint8_t attr_val;
|
|
Packit Service |
8264ee |
int err;
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
err = create_hid_dev_name(rec, req);
|
|
Packit Service |
8264ee |
if (err < 0)
|
|
Packit Service |
8264ee |
DBG("No valid Service Name or Service Description found");
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
pdlist = sdp_data_get(rec, SDP_ATTR_HID_PARSER_VERSION);
|
|
Packit Service |
8264ee |
req->parser = pdlist ? pdlist->val.uint16 : 0x0100;
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
pdlist = sdp_data_get(rec, SDP_ATTR_HID_DEVICE_SUBCLASS);
|
|
Packit Service |
8264ee |
req->subclass = pdlist ? pdlist->val.uint8 : 0;
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
pdlist = sdp_data_get(rec, SDP_ATTR_HID_COUNTRY_CODE);
|
|
Packit Service |
8264ee |
req->country = pdlist ? pdlist->val.uint8 : 0;
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
pdlist = sdp_data_get(rec, SDP_ATTR_HID_VIRTUAL_CABLE);
|
|
Packit Service |
8264ee |
attr_val = pdlist ? pdlist->val.uint8 : 0;
|
|
Packit Service |
8264ee |
if (attr_val)
|
|
Packit Service |
8264ee |
req->flags |= (1 << HIDP_VIRTUAL_CABLE_UNPLUG);
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
pdlist = sdp_data_get(rec, SDP_ATTR_HID_BOOT_DEVICE);
|
|
Packit Service |
8264ee |
attr_val = pdlist ? pdlist->val.uint8 : 0;
|
|
Packit Service |
8264ee |
if (attr_val)
|
|
Packit Service |
8264ee |
req->flags |= (1 << HIDP_BOOT_PROTOCOL_MODE);
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
err = extract_hid_desc_data(rec, req);
|
|
Packit Service |
8264ee |
if (err < 0)
|
|
Packit Service |
8264ee |
return err;
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
return 0;
|
|
Packit Service |
8264ee |
}
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
static int ioctl_connadd(struct hidp_connadd_req *req)
|
|
Packit Service |
8264ee |
{
|
|
Packit Service |
8264ee |
int ctl, err = 0;
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
ctl = socket(AF_BLUETOOTH, SOCK_RAW, BTPROTO_HIDP);
|
|
Packit Service |
8264ee |
if (ctl < 0)
|
|
Packit Service |
8264ee |
return -errno;
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
if (ioctl(ctl, HIDPCONNADD, req) < 0)
|
|
Packit Service |
8264ee |
err = -errno;
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
close(ctl);
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
return err;
|
|
Packit Service |
8264ee |
}
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
static bool ioctl_is_connected(struct input_device *idev)
|
|
Packit Service |
8264ee |
{
|
|
Packit Service |
8264ee |
struct hidp_conninfo ci;
|
|
Packit Service |
8264ee |
int ctl;
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
/* Standard HID */
|
|
Packit Service |
8264ee |
ctl = socket(AF_BLUETOOTH, SOCK_RAW, BTPROTO_HIDP);
|
|
Packit Service |
8264ee |
if (ctl < 0) {
|
|
Packit Service |
8264ee |
error("Can't open HIDP control socket");
|
|
Packit Service |
8264ee |
return false;
|
|
Packit Service |
8264ee |
}
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
memset(&ci, 0, sizeof(ci));
|
|
Packit Service |
8264ee |
bacpy(&ci.bdaddr, &idev->dst);
|
|
Packit Service |
8264ee |
if (ioctl(ctl, HIDPGETCONNINFO, &ci) < 0) {
|
|
Packit Service |
8264ee |
error("Can't get HIDP connection info");
|
|
Packit Service |
8264ee |
close(ctl);
|
|
Packit Service |
8264ee |
return false;
|
|
Packit Service |
8264ee |
}
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
close(ctl);
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
if (ci.state != BT_CONNECTED)
|
|
Packit Service |
8264ee |
return false;
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
return true;
|
|
Packit Service |
8264ee |
}
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
static int ioctl_disconnect(struct input_device *idev, uint32_t flags)
|
|
Packit Service |
8264ee |
{
|
|
Packit Service |
8264ee |
struct hidp_conndel_req req;
|
|
Packit Service |
8264ee |
struct hidp_conninfo ci;
|
|
Packit Service |
8264ee |
int ctl, err = 0;
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
ctl = socket(AF_BLUETOOTH, SOCK_RAW, BTPROTO_HIDP);
|
|
Packit Service |
8264ee |
if (ctl < 0) {
|
|
Packit Service |
8264ee |
error("Can't open HIDP control socket");
|
|
Packit Service |
8264ee |
return -errno;
|
|
Packit Service |
8264ee |
}
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
memset(&ci, 0, sizeof(ci));
|
|
Packit Service |
8264ee |
bacpy(&ci.bdaddr, &idev->dst);
|
|
Packit Service |
8264ee |
if ((ioctl(ctl, HIDPGETCONNINFO, &ci) < 0) ||
|
|
Packit Service |
8264ee |
(ci.state != BT_CONNECTED)) {
|
|
Packit Service |
8264ee |
close(ctl);
|
|
Packit Service |
8264ee |
return -ENOTCONN;
|
|
Packit Service |
8264ee |
}
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
memset(&req, 0, sizeof(req));
|
|
Packit Service |
8264ee |
bacpy(&req.bdaddr, &idev->dst);
|
|
Packit Service |
8264ee |
req.flags = flags;
|
|
Packit Service |
8264ee |
if (ioctl(ctl, HIDPCONNDEL, &req) < 0) {
|
|
Packit Service |
8264ee |
err = -errno;
|
|
Packit Service |
8264ee |
error("Can't delete the HID device: %s (%d)",
|
|
Packit Service |
8264ee |
strerror(-err), -err);
|
|
Packit Service |
8264ee |
}
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
close(ctl);
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
return err;
|
|
Packit Service |
8264ee |
}
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
static int uhid_connadd(struct input_device *idev, struct hidp_connadd_req *req)
|
|
Packit Service |
8264ee |
{
|
|
Packit Service |
8264ee |
int err;
|
|
Packit Service |
8264ee |
struct uhid_event ev;
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
if (idev->uhid_created)
|
|
Packit Service |
8264ee |
return 0;
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
/* create uHID device */
|
|
Packit Service |
8264ee |
memset(&ev, 0, sizeof(ev));
|
|
Packit Service |
8264ee |
ev.type = UHID_CREATE;
|
|
Packit Service |
8264ee |
strncpy((char *) ev.u.create.name, req->name, sizeof(ev.u.create.name));
|
|
Packit Service |
8264ee |
ba2str(&idev->src, (char *) ev.u.create.phys);
|
|
Packit Service |
8264ee |
ba2str(&idev->dst, (char *) ev.u.create.uniq);
|
|
Packit Service |
8264ee |
ev.u.create.vendor = req->vendor;
|
|
Packit Service |
8264ee |
ev.u.create.product = req->product;
|
|
Packit Service |
8264ee |
ev.u.create.version = req->version;
|
|
Packit Service |
8264ee |
ev.u.create.country = req->country;
|
|
Packit Service |
8264ee |
ev.u.create.bus = BUS_BLUETOOTH;
|
|
Packit Service |
8264ee |
ev.u.create.rd_data = req->rd_data;
|
|
Packit Service |
8264ee |
ev.u.create.rd_size = req->rd_size;
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
err = bt_uhid_send(idev->uhid, &ev;;
|
|
Packit Service |
8264ee |
if (err < 0) {
|
|
Packit Service |
8264ee |
error("bt_uhid_send: %s", strerror(-err));
|
|
Packit Service |
8264ee |
return err;
|
|
Packit Service |
8264ee |
}
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
bt_uhid_register(idev->uhid, UHID_OUTPUT, hidp_send_set_report, idev);
|
|
Packit Service |
8264ee |
bt_uhid_register(idev->uhid, UHID_FEATURE, hidp_send_get_report, idev);
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
idev->uhid_created = true;
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
return err;
|
|
Packit Service |
8264ee |
}
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
static gboolean encrypt_notify(GIOChannel *io, GIOCondition condition,
|
|
Packit Service |
8264ee |
gpointer data)
|
|
Packit Service |
8264ee |
{
|
|
Packit Service |
8264ee |
struct input_device *idev = data;
|
|
Packit Service |
8264ee |
int err;
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
DBG("");
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
if (idev->uhid)
|
|
Packit Service |
8264ee |
err = uhid_connadd(idev, idev->req);
|
|
Packit Service |
8264ee |
else
|
|
Packit Service |
8264ee |
err = ioctl_connadd(idev->req);
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
if (err < 0) {
|
|
Packit Service |
8264ee |
error("ioctl_connadd(): %s (%d)", strerror(-err), -err);
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
if (idev->ctrl_io) {
|
|
Packit Service |
8264ee |
g_io_channel_shutdown(idev->ctrl_io, FALSE, NULL);
|
|
Packit Service |
8264ee |
g_io_channel_unref(idev->ctrl_io);
|
|
Packit Service |
8264ee |
idev->ctrl_io = NULL;
|
|
Packit Service |
8264ee |
}
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
if (idev->intr_io) {
|
|
Packit Service |
8264ee |
g_io_channel_shutdown(idev->intr_io, FALSE, NULL);
|
|
Packit Service |
8264ee |
g_io_channel_unref(idev->intr_io);
|
|
Packit Service |
8264ee |
idev->intr_io = NULL;
|
|
Packit Service |
8264ee |
}
|
|
Packit Service |
8264ee |
}
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
idev->sec_watch = 0;
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
g_free(idev->req->rd_data);
|
|
Packit Service |
8264ee |
g_free(idev->req);
|
|
Packit Service |
8264ee |
idev->req = NULL;
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
return FALSE;
|
|
Packit Service |
8264ee |
}
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
static int hidp_add_connection(struct input_device *idev)
|
|
Packit Service |
8264ee |
{
|
|
Packit Service |
8264ee |
struct hidp_connadd_req *req;
|
|
Packit Service |
8264ee |
sdp_record_t *rec;
|
|
Packit Service |
8264ee |
char src_addr[18], dst_addr[18];
|
|
Packit Service |
8264ee |
char filename[PATH_MAX];
|
|
Packit Service |
8264ee |
GKeyFile *key_file;
|
|
Packit Service |
8264ee |
char handle[11], *str;
|
|
Packit Service |
8264ee |
GError *gerr = NULL;
|
|
Packit Service |
8264ee |
int err;
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
req = g_new0(struct hidp_connadd_req, 1);
|
|
Packit Service |
8264ee |
req->ctrl_sock = g_io_channel_unix_get_fd(idev->ctrl_io);
|
|
Packit Service |
8264ee |
req->intr_sock = g_io_channel_unix_get_fd(idev->intr_io);
|
|
Packit Service |
8264ee |
req->flags = 0;
|
|
Packit Service |
8264ee |
req->idle_to = idle_timeout;
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
ba2str(&idev->src, src_addr);
|
|
Packit Service |
8264ee |
ba2str(&idev->dst, dst_addr);
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
snprintf(filename, PATH_MAX, STORAGEDIR "/%s/cache/%s", src_addr,
|
|
Packit Service |
8264ee |
dst_addr);
|
|
Packit Service |
8264ee |
sprintf(handle, "0x%8.8X", idev->handle);
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
key_file = g_key_file_new();
|
|
Packit Service |
8264ee |
g_key_file_load_from_file(key_file, filename, 0, NULL);
|
|
Packit Service |
8264ee |
str = g_key_file_get_string(key_file, "ServiceRecords", handle, NULL);
|
|
Packit Service |
8264ee |
g_key_file_free(key_file);
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
if (!str) {
|
|
Packit Service |
8264ee |
error("Rejected connection from unknown device %s", dst_addr);
|
|
Packit Service |
8264ee |
err = -EPERM;
|
|
Packit Service |
8264ee |
goto cleanup;
|
|
Packit Service |
8264ee |
}
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
rec = record_from_string(str);
|
|
Packit Service |
8264ee |
g_free(str);
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
err = extract_hid_record(rec, req);
|
|
Packit Service |
8264ee |
sdp_record_free(rec);
|
|
Packit Service |
8264ee |
if (err < 0) {
|
|
Packit Service |
8264ee |
error("Could not parse HID SDP record: %s (%d)", strerror(-err),
|
|
Packit Service |
8264ee |
-err);
|
|
Packit Service |
8264ee |
goto cleanup;
|
|
Packit Service |
8264ee |
}
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
req->vendor = btd_device_get_vendor(idev->device);
|
|
Packit Service |
8264ee |
req->product = btd_device_get_product(idev->device);
|
|
Packit Service |
8264ee |
req->version = btd_device_get_version(idev->device);
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
if (device_name_known(idev->device))
|
|
Packit Service |
8264ee |
device_get_name(idev->device, req->name, sizeof(req->name));
|
|
Packit Service |
8264ee |
|
|
rpm-build |
300f4b |
/* Make sure the device is bonded if required */
|
|
rpm-build |
300f4b |
if (classic_bonded_only && !device_is_bonded(idev->device,
|
|
rpm-build |
300f4b |
btd_device_get_bdaddr_type(idev->device))) {
|
|
rpm-build |
300f4b |
error("Rejected connection from !bonded device %s", dst_addr);
|
|
rpm-build |
300f4b |
goto cleanup;
|
|
rpm-build |
300f4b |
}
|
|
rpm-build |
300f4b |
|
|
Packit Service |
8264ee |
/* Encryption is mandatory for keyboards */
|
|
rpm-build |
300f4b |
/* Some platforms may choose to require encryption for all devices */
|
|
rpm-build |
300f4b |
/* Note that this only matters for pre 2.1 devices as otherwise the */
|
|
rpm-build |
300f4b |
/* device is encrypted by default by the lower layers */
|
|
rpm-build |
300f4b |
if (classic_bonded_only || req->subclass & 0x40) {
|
|
Packit Service |
8264ee |
if (!bt_io_set(idev->intr_io, &gerr,
|
|
Packit Service |
8264ee |
BT_IO_OPT_SEC_LEVEL, BT_IO_SEC_MEDIUM,
|
|
Packit Service |
8264ee |
BT_IO_OPT_INVALID)) {
|
|
Packit Service |
8264ee |
error("btio: %s", gerr->message);
|
|
Packit Service |
8264ee |
g_error_free(gerr);
|
|
Packit Service |
8264ee |
err = -EFAULT;
|
|
Packit Service |
8264ee |
goto cleanup;
|
|
Packit Service |
8264ee |
}
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
idev->req = req;
|
|
Packit Service |
8264ee |
idev->sec_watch = g_io_add_watch(idev->intr_io, G_IO_OUT,
|
|
Packit Service |
8264ee |
encrypt_notify, idev);
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
return 0;
|
|
Packit Service |
8264ee |
}
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
if (idev->uhid)
|
|
Packit Service |
8264ee |
err = uhid_connadd(idev, req);
|
|
Packit Service |
8264ee |
else
|
|
Packit Service |
8264ee |
err = ioctl_connadd(req);
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
cleanup:
|
|
Packit Service |
8264ee |
g_free(req->rd_data);
|
|
Packit Service |
8264ee |
g_free(req);
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
return err;
|
|
Packit Service |
8264ee |
}
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
static bool is_connected(struct input_device *idev)
|
|
Packit Service |
8264ee |
{
|
|
Packit Service |
8264ee |
if (idev->uhid)
|
|
Packit Service |
8264ee |
return (idev->intr_io != NULL && idev->ctrl_io != NULL);
|
|
Packit Service |
8264ee |
else
|
|
Packit Service |
8264ee |
return ioctl_is_connected(idev);
|
|
Packit Service |
8264ee |
}
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
static int connection_disconnect(struct input_device *idev, uint32_t flags)
|
|
Packit Service |
8264ee |
{
|
|
Packit Service |
8264ee |
if (!is_connected(idev))
|
|
Packit Service |
8264ee |
return -ENOTCONN;
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
/* Standard HID disconnect */
|
|
Packit Service |
8264ee |
if (idev->intr_io)
|
|
Packit Service |
8264ee |
g_io_channel_shutdown(idev->intr_io, TRUE, NULL);
|
|
Packit Service |
8264ee |
if (idev->ctrl_io)
|
|
Packit Service |
8264ee |
g_io_channel_shutdown(idev->ctrl_io, TRUE, NULL);
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
if (idev->uhid)
|
|
Packit Service |
8264ee |
return 0;
|
|
Packit Service |
8264ee |
else
|
|
Packit Service |
8264ee |
return ioctl_disconnect(idev, flags);
|
|
Packit Service |
8264ee |
}
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
static int input_device_connected(struct input_device *idev)
|
|
Packit Service |
8264ee |
{
|
|
Packit Service |
8264ee |
int err;
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
if (idev->intr_io == NULL || idev->ctrl_io == NULL)
|
|
Packit Service |
8264ee |
return -ENOTCONN;
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
err = hidp_add_connection(idev);
|
|
Packit Service |
8264ee |
if (err < 0)
|
|
Packit Service |
8264ee |
return err;
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
btd_service_connecting_complete(idev->service, 0);
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
return 0;
|
|
Packit Service |
8264ee |
}
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
static void interrupt_connect_cb(GIOChannel *chan, GError *conn_err,
|
|
Packit Service |
8264ee |
gpointer user_data)
|
|
Packit Service |
8264ee |
{
|
|
Packit Service |
8264ee |
struct input_device *idev = user_data;
|
|
Packit Service |
8264ee |
GIOCondition cond = G_IO_HUP | G_IO_ERR | G_IO_NVAL;
|
|
Packit Service |
8264ee |
int err;
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
if (conn_err) {
|
|
Packit Service |
8264ee |
err = -EIO;
|
|
Packit Service |
8264ee |
goto failed;
|
|
Packit Service |
8264ee |
}
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
err = input_device_connected(idev);
|
|
Packit Service |
8264ee |
if (err < 0)
|
|
Packit Service |
8264ee |
goto failed;
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
if (idev->uhid)
|
|
Packit Service |
8264ee |
cond |= G_IO_IN;
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
idev->intr_watch = g_io_add_watch(idev->intr_io, cond, intr_watch_cb,
|
|
Packit Service |
8264ee |
idev);
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
return;
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
failed:
|
|
Packit Service |
8264ee |
btd_service_connecting_complete(idev->service, err);
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
/* So we guarantee the interrupt channel is closed before the
|
|
Packit Service |
8264ee |
* control channel (if we only do unref GLib will close it only
|
|
Packit Service |
8264ee |
* after returning control to the mainloop */
|
|
Packit Service |
8264ee |
if (!conn_err)
|
|
Packit Service |
8264ee |
g_io_channel_shutdown(idev->intr_io, FALSE, NULL);
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
g_io_channel_unref(idev->intr_io);
|
|
Packit Service |
8264ee |
idev->intr_io = NULL;
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
if (idev->ctrl_io) {
|
|
Packit Service |
8264ee |
g_io_channel_unref(idev->ctrl_io);
|
|
Packit Service |
8264ee |
idev->ctrl_io = NULL;
|
|
Packit Service |
8264ee |
}
|
|
Packit Service |
8264ee |
}
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
static void control_connect_cb(GIOChannel *chan, GError *conn_err,
|
|
Packit Service |
8264ee |
gpointer user_data)
|
|
Packit Service |
8264ee |
{
|
|
Packit Service |
8264ee |
struct input_device *idev = user_data;
|
|
Packit Service |
8264ee |
GIOCondition cond = G_IO_HUP | G_IO_ERR | G_IO_NVAL;
|
|
Packit Service |
8264ee |
GIOChannel *io;
|
|
Packit Service |
8264ee |
GError *err = NULL;
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
if (conn_err) {
|
|
Packit Service |
8264ee |
error("%s", conn_err->message);
|
|
Packit Service |
8264ee |
goto failed;
|
|
Packit Service |
8264ee |
}
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
/* Connect to the HID interrupt channel */
|
|
Packit Service |
8264ee |
io = bt_io_connect(interrupt_connect_cb, idev,
|
|
Packit Service |
8264ee |
NULL, &err,
|
|
Packit Service |
8264ee |
BT_IO_OPT_SOURCE_BDADDR, &idev->src,
|
|
Packit Service |
8264ee |
BT_IO_OPT_DEST_BDADDR, &idev->dst,
|
|
Packit Service |
8264ee |
BT_IO_OPT_PSM, L2CAP_PSM_HIDP_INTR,
|
|
Packit Service |
8264ee |
BT_IO_OPT_SEC_LEVEL, BT_IO_SEC_LOW,
|
|
Packit Service |
8264ee |
BT_IO_OPT_INVALID);
|
|
Packit Service |
8264ee |
if (!io) {
|
|
Packit Service |
8264ee |
error("%s", err->message);
|
|
Packit Service |
8264ee |
g_error_free(err);
|
|
Packit Service |
8264ee |
goto failed;
|
|
Packit Service |
8264ee |
}
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
idev->intr_io = io;
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
if (idev->uhid)
|
|
Packit Service |
8264ee |
cond |= G_IO_IN;
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
idev->ctrl_watch = g_io_add_watch(idev->ctrl_io, cond, ctrl_watch_cb,
|
|
Packit Service |
8264ee |
idev);
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
return;
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
failed:
|
|
Packit Service |
8264ee |
btd_service_connecting_complete(idev->service, -EIO);
|
|
Packit Service |
8264ee |
g_io_channel_unref(idev->ctrl_io);
|
|
Packit Service |
8264ee |
idev->ctrl_io = NULL;
|
|
Packit Service |
8264ee |
}
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
static int dev_connect(struct input_device *idev)
|
|
Packit Service |
8264ee |
{
|
|
Packit Service |
8264ee |
GError *err = NULL;
|
|
Packit Service |
8264ee |
GIOChannel *io;
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
if (idev->disable_sdp)
|
|
Packit Service |
8264ee |
bt_clear_cached_session(&idev->src, &idev->dst);
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
io = bt_io_connect(control_connect_cb, idev,
|
|
Packit Service |
8264ee |
NULL, &err,
|
|
Packit Service |
8264ee |
BT_IO_OPT_SOURCE_BDADDR, &idev->src,
|
|
Packit Service |
8264ee |
BT_IO_OPT_DEST_BDADDR, &idev->dst,
|
|
Packit Service |
8264ee |
BT_IO_OPT_PSM, L2CAP_PSM_HIDP_CTRL,
|
|
Packit Service |
8264ee |
BT_IO_OPT_SEC_LEVEL, BT_IO_SEC_LOW,
|
|
Packit Service |
8264ee |
BT_IO_OPT_INVALID);
|
|
Packit Service |
8264ee |
idev->ctrl_io = io;
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
if (err == NULL)
|
|
Packit Service |
8264ee |
return 0;
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
error("%s", err->message);
|
|
Packit Service |
8264ee |
g_error_free(err);
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
return -EIO;
|
|
Packit Service |
8264ee |
}
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
static gboolean input_device_auto_reconnect(gpointer user_data)
|
|
Packit Service |
8264ee |
{
|
|
Packit Service |
8264ee |
struct input_device *idev = user_data;
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
DBG("path=%s, attempt=%d", idev->path, idev->reconnect_attempt);
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
/* Stop the recurrent reconnection attempts if the device is
|
|
Packit Service |
8264ee |
* reconnected or is marked for removal.
|
|
Packit Service |
8264ee |
*/
|
|
Packit Service |
8264ee |
if (device_is_temporary(idev->device) ||
|
|
Packit Service |
8264ee |
btd_device_is_connected(idev->device))
|
|
Packit Service |
8264ee |
goto bail;
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
/* Only attempt an auto-reconnect for at most 3 minutes (6 * 30s). */
|
|
Packit Service |
8264ee |
if (idev->reconnect_attempt >= 6)
|
|
Packit Service |
8264ee |
goto bail;
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
/* Check if the profile is already connected. */
|
|
Packit Service |
8264ee |
if (idev->ctrl_io)
|
|
Packit Service |
8264ee |
goto bail;
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
if (is_connected(idev))
|
|
Packit Service |
8264ee |
goto bail;
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
idev->reconnect_attempt++;
|
|
Packit Service |
8264ee |
dev_connect(idev);
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
return TRUE;
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
bail:
|
|
Packit Service |
8264ee |
idev->reconnect_timer = 0;
|
|
Packit Service |
8264ee |
return FALSE;
|
|
Packit Service |
8264ee |
}
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
static const char * const _reconnect_mode_str[] = {
|
|
Packit Service |
8264ee |
"none",
|
|
Packit Service |
8264ee |
"device",
|
|
Packit Service |
8264ee |
"host",
|
|
Packit Service |
8264ee |
"any"
|
|
Packit Service |
8264ee |
};
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
static const char *reconnect_mode_to_string(const enum reconnect_mode_t mode)
|
|
Packit Service |
8264ee |
{
|
|
Packit Service |
8264ee |
return _reconnect_mode_str[mode];
|
|
Packit Service |
8264ee |
}
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
static void input_device_enter_reconnect_mode(struct input_device *idev)
|
|
Packit Service |
8264ee |
{
|
|
Packit Service |
8264ee |
DBG("path=%s reconnect_mode=%s", idev->path,
|
|
Packit Service |
8264ee |
reconnect_mode_to_string(idev->reconnect_mode));
|
|
Packit Service |
8264ee |
|
|
rpm-build |
300f4b |
/* Make sure the device is bonded if required */
|
|
rpm-build |
300f4b |
if (classic_bonded_only && !device_is_bonded(idev->device,
|
|
rpm-build |
300f4b |
btd_device_get_bdaddr_type(idev->device)))
|
|
rpm-build |
300f4b |
return;
|
|
rpm-build |
300f4b |
|
|
Packit Service |
8264ee |
/* Only attempt an auto-reconnect when the device is required to
|
|
Packit Service |
8264ee |
* accept reconnections from the host.
|
|
Packit Service |
8264ee |
*/
|
|
Packit Service |
8264ee |
if (idev->reconnect_mode != RECONNECT_ANY &&
|
|
Packit Service |
8264ee |
idev->reconnect_mode != RECONNECT_HOST)
|
|
Packit Service |
8264ee |
return;
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
/* If the device is temporary we are not required to reconnect
|
|
Packit Service |
8264ee |
* with the device. This is likely the case of a removing device.
|
|
Packit Service |
8264ee |
*/
|
|
Packit Service |
8264ee |
if (device_is_temporary(idev->device) ||
|
|
Packit Service |
8264ee |
btd_device_is_connected(idev->device))
|
|
Packit Service |
8264ee |
return;
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
if (idev->reconnect_timer > 0)
|
|
Packit Service |
8264ee |
g_source_remove(idev->reconnect_timer);
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
DBG("registering auto-reconnect");
|
|
Packit Service |
8264ee |
idev->reconnect_attempt = 0;
|
|
Packit Service |
8264ee |
idev->reconnect_timer = g_timeout_add_seconds(30,
|
|
Packit Service |
8264ee |
input_device_auto_reconnect, idev);
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
}
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
int input_device_connect(struct btd_service *service)
|
|
Packit Service |
8264ee |
{
|
|
Packit Service |
8264ee |
struct input_device *idev;
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
DBG("");
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
idev = btd_service_get_user_data(service);
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
if (idev->ctrl_io)
|
|
Packit Service |
8264ee |
return -EBUSY;
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
if (is_connected(idev))
|
|
Packit Service |
8264ee |
return -EALREADY;
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
return dev_connect(idev);
|
|
Packit Service |
8264ee |
}
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
int input_device_disconnect(struct btd_service *service)
|
|
Packit Service |
8264ee |
{
|
|
Packit Service |
8264ee |
struct input_device *idev;
|
|
Packit Service |
8264ee |
int err, flags;
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
DBG("");
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
idev = btd_service_get_user_data(service);
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
flags = device_is_temporary(idev->device) ?
|
|
Packit Service |
8264ee |
(1 << HIDP_VIRTUAL_CABLE_UNPLUG) : 0;
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
err = connection_disconnect(idev, flags);
|
|
Packit Service |
8264ee |
if (err < 0)
|
|
Packit Service |
8264ee |
return err;
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
return 0;
|
|
Packit Service |
8264ee |
}
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
static bool is_device_sdp_disable(const sdp_record_t *rec)
|
|
Packit Service |
8264ee |
{
|
|
Packit Service |
8264ee |
sdp_data_t *data;
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
data = sdp_data_get(rec, SDP_ATTR_HID_SDP_DISABLE);
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
return data && data->val.uint8;
|
|
Packit Service |
8264ee |
}
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
static enum reconnect_mode_t hid_reconnection_mode(bool reconnect_initiate,
|
|
Packit Service |
8264ee |
bool normally_connectable)
|
|
Packit Service |
8264ee |
{
|
|
Packit Service |
8264ee |
if (!reconnect_initiate && !normally_connectable)
|
|
Packit Service |
8264ee |
return RECONNECT_NONE;
|
|
Packit Service |
8264ee |
else if (!reconnect_initiate && normally_connectable)
|
|
Packit Service |
8264ee |
return RECONNECT_HOST;
|
|
Packit Service |
8264ee |
else if (reconnect_initiate && !normally_connectable)
|
|
Packit Service |
8264ee |
return RECONNECT_DEVICE;
|
|
Packit Service |
8264ee |
else /* (reconnect_initiate && normally_connectable) */
|
|
Packit Service |
8264ee |
return RECONNECT_ANY;
|
|
Packit Service |
8264ee |
}
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
static void extract_hid_props(struct input_device *idev,
|
|
Packit Service |
8264ee |
const sdp_record_t *rec)
|
|
Packit Service |
8264ee |
{
|
|
Packit Service |
8264ee |
/* Extract HID connectability */
|
|
Packit Service |
8264ee |
bool reconnect_initiate, normally_connectable;
|
|
Packit Service |
8264ee |
sdp_data_t *pdlist;
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
/* HIDNormallyConnectable is optional and assumed FALSE
|
|
Packit Service |
8264ee |
* if not present. */
|
|
Packit Service |
8264ee |
pdlist = sdp_data_get(rec, SDP_ATTR_HID_RECONNECT_INITIATE);
|
|
Packit Service |
8264ee |
reconnect_initiate = pdlist ? pdlist->val.uint8 : TRUE;
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
pdlist = sdp_data_get(rec, SDP_ATTR_HID_NORMALLY_CONNECTABLE);
|
|
Packit Service |
8264ee |
normally_connectable = pdlist ? pdlist->val.uint8 : FALSE;
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
/* Update local values */
|
|
Packit Service |
8264ee |
idev->reconnect_mode =
|
|
Packit Service |
8264ee |
hid_reconnection_mode(reconnect_initiate, normally_connectable);
|
|
Packit Service |
8264ee |
}
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
static struct input_device *input_device_new(struct btd_service *service)
|
|
Packit Service |
8264ee |
{
|
|
Packit Service |
8264ee |
struct btd_device *device = btd_service_get_device(service);
|
|
Packit Service |
8264ee |
struct btd_profile *p = btd_service_get_profile(service);
|
|
Packit Service |
8264ee |
const char *path = device_get_path(device);
|
|
Packit Service |
8264ee |
const sdp_record_t *rec = btd_device_get_record(device, p->remote_uuid);
|
|
Packit Service |
8264ee |
struct btd_adapter *adapter = device_get_adapter(device);
|
|
Packit Service |
8264ee |
struct input_device *idev;
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
if (!rec)
|
|
Packit Service |
8264ee |
return NULL;
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
idev = g_new0(struct input_device, 1);
|
|
Packit Service |
8264ee |
bacpy(&idev->src, btd_adapter_get_address(adapter));
|
|
Packit Service |
8264ee |
bacpy(&idev->dst, device_get_address(device));
|
|
Packit Service |
8264ee |
idev->service = btd_service_ref(service);
|
|
Packit Service |
8264ee |
idev->device = btd_device_ref(device);
|
|
Packit Service |
8264ee |
idev->path = g_strdup(path);
|
|
Packit Service |
8264ee |
idev->handle = rec->handle;
|
|
Packit Service |
8264ee |
idev->disable_sdp = is_device_sdp_disable(rec);
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
/* Initialize device properties */
|
|
Packit Service |
8264ee |
extract_hid_props(idev, rec);
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
return idev;
|
|
Packit Service |
8264ee |
}
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
static gboolean property_get_reconnect_mode(
|
|
Packit Service |
8264ee |
const GDBusPropertyTable *property,
|
|
Packit Service |
8264ee |
DBusMessageIter *iter, void *data)
|
|
Packit Service |
8264ee |
{
|
|
Packit Service |
8264ee |
struct input_device *idev = data;
|
|
Packit Service |
8264ee |
const char *str_mode = reconnect_mode_to_string(idev->reconnect_mode);
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
dbus_message_iter_append_basic(iter, DBUS_TYPE_STRING, &str_mode);
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
return TRUE;
|
|
Packit Service |
8264ee |
}
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
static const GDBusPropertyTable input_properties[] = {
|
|
Packit Service |
8264ee |
{ "ReconnectMode", "s", property_get_reconnect_mode },
|
|
Packit Service |
8264ee |
{ }
|
|
Packit Service |
8264ee |
};
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
int input_device_register(struct btd_service *service)
|
|
Packit Service |
8264ee |
{
|
|
Packit Service |
8264ee |
struct btd_device *device = btd_service_get_device(service);
|
|
Packit Service |
8264ee |
const char *path = device_get_path(device);
|
|
Packit Service |
8264ee |
struct input_device *idev;
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
DBG("%s", path);
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
idev = input_device_new(service);
|
|
Packit Service |
8264ee |
if (!idev)
|
|
Packit Service |
8264ee |
return -EINVAL;
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
if (uhid_enabled) {
|
|
Packit Service |
8264ee |
idev->uhid = bt_uhid_new_default();
|
|
Packit Service |
8264ee |
if (!idev->uhid) {
|
|
Packit Service |
8264ee |
error("bt_uhid_new_default: failed");
|
|
Packit Service |
8264ee |
input_device_free(idev);
|
|
Packit Service |
8264ee |
return -EIO;
|
|
Packit Service |
8264ee |
}
|
|
Packit Service |
8264ee |
}
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
if (g_dbus_register_interface(btd_get_dbus_connection(),
|
|
Packit Service |
8264ee |
idev->path, INPUT_INTERFACE,
|
|
Packit Service |
8264ee |
NULL, NULL,
|
|
Packit Service |
8264ee |
input_properties, idev,
|
|
Packit Service |
8264ee |
NULL) == FALSE) {
|
|
Packit Service |
8264ee |
error("Unable to register %s interface", INPUT_INTERFACE);
|
|
Packit Service |
8264ee |
input_device_free(idev);
|
|
Packit Service |
8264ee |
return -EINVAL;
|
|
Packit Service |
8264ee |
}
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
btd_service_set_user_data(service, idev);
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
return 0;
|
|
Packit Service |
8264ee |
}
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
static struct input_device *find_device(const bdaddr_t *src,
|
|
Packit Service |
8264ee |
const bdaddr_t *dst)
|
|
Packit Service |
8264ee |
{
|
|
Packit Service |
8264ee |
struct btd_device *device;
|
|
Packit Service |
8264ee |
struct btd_service *service;
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
device = btd_adapter_find_device(adapter_find(src), dst, BDADDR_BREDR);
|
|
Packit Service |
8264ee |
if (device == NULL)
|
|
Packit Service |
8264ee |
return NULL;
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
service = btd_device_get_service(device, HID_UUID);
|
|
Packit Service |
8264ee |
if (service == NULL)
|
|
Packit Service |
8264ee |
return NULL;
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
return btd_service_get_user_data(service);
|
|
Packit Service |
8264ee |
}
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
void input_device_unregister(struct btd_service *service)
|
|
Packit Service |
8264ee |
{
|
|
Packit Service |
8264ee |
struct btd_device *device = btd_service_get_device(service);
|
|
Packit Service |
8264ee |
const char *path = device_get_path(device);
|
|
Packit Service |
8264ee |
struct input_device *idev = btd_service_get_user_data(service);
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
DBG("%s", path);
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
g_dbus_unregister_interface(btd_get_dbus_connection(),
|
|
Packit Service |
8264ee |
idev->path, INPUT_INTERFACE);
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
input_device_free(idev);
|
|
Packit Service |
8264ee |
}
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
static int input_device_connadd(struct input_device *idev)
|
|
Packit Service |
8264ee |
{
|
|
Packit Service |
8264ee |
int err;
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
err = input_device_connected(idev);
|
|
Packit Service |
8264ee |
if (err == 0)
|
|
Packit Service |
8264ee |
return 0;
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
if (idev->ctrl_io) {
|
|
Packit Service |
8264ee |
g_io_channel_shutdown(idev->ctrl_io, FALSE, NULL);
|
|
Packit Service |
8264ee |
g_io_channel_unref(idev->ctrl_io);
|
|
Packit Service |
8264ee |
idev->ctrl_io = NULL;
|
|
Packit Service |
8264ee |
}
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
if (idev->intr_io) {
|
|
Packit Service |
8264ee |
g_io_channel_shutdown(idev->intr_io, FALSE, NULL);
|
|
Packit Service |
8264ee |
g_io_channel_unref(idev->intr_io);
|
|
Packit Service |
8264ee |
idev->intr_io = NULL;
|
|
Packit Service |
8264ee |
}
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
return err;
|
|
Packit Service |
8264ee |
}
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
bool input_device_exists(const bdaddr_t *src, const bdaddr_t *dst)
|
|
Packit Service |
8264ee |
{
|
|
Packit Service |
8264ee |
if (find_device(src, dst))
|
|
Packit Service |
8264ee |
return true;
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
return false;
|
|
Packit Service |
8264ee |
}
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
int input_device_set_channel(const bdaddr_t *src, const bdaddr_t *dst, int psm,
|
|
Packit Service |
8264ee |
GIOChannel *io)
|
|
Packit Service |
8264ee |
{
|
|
Packit Service |
8264ee |
struct input_device *idev = find_device(src, dst);
|
|
Packit Service |
8264ee |
GIOCondition cond = G_IO_HUP | G_IO_ERR | G_IO_NVAL;
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
DBG("idev %p psm %d", idev, psm);
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
if (!idev)
|
|
Packit Service |
8264ee |
return -ENOENT;
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
if (uhid_enabled)
|
|
Packit Service |
8264ee |
cond |= G_IO_IN;
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
switch (psm) {
|
|
Packit Service |
8264ee |
case L2CAP_PSM_HIDP_CTRL:
|
|
Packit Service |
8264ee |
if (idev->ctrl_io)
|
|
Packit Service |
8264ee |
return -EALREADY;
|
|
Packit Service |
8264ee |
idev->ctrl_io = g_io_channel_ref(io);
|
|
Packit Service |
8264ee |
idev->ctrl_watch = g_io_add_watch(idev->ctrl_io, cond,
|
|
Packit Service |
8264ee |
ctrl_watch_cb, idev);
|
|
Packit Service |
8264ee |
break;
|
|
Packit Service |
8264ee |
case L2CAP_PSM_HIDP_INTR:
|
|
Packit Service |
8264ee |
if (idev->intr_io)
|
|
Packit Service |
8264ee |
return -EALREADY;
|
|
Packit Service |
8264ee |
idev->intr_io = g_io_channel_ref(io);
|
|
Packit Service |
8264ee |
idev->intr_watch = g_io_add_watch(idev->intr_io, cond,
|
|
Packit Service |
8264ee |
intr_watch_cb, idev);
|
|
Packit Service |
8264ee |
break;
|
|
Packit Service |
8264ee |
}
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
if (idev->intr_io && idev->ctrl_io)
|
|
Packit Service |
8264ee |
input_device_connadd(idev);
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
return 0;
|
|
Packit Service |
8264ee |
}
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
int input_device_close_channels(const bdaddr_t *src, const bdaddr_t *dst)
|
|
Packit Service |
8264ee |
{
|
|
Packit Service |
8264ee |
struct input_device *idev = find_device(src, dst);
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
if (!idev)
|
|
Packit Service |
8264ee |
return -ENOENT;
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
if (idev->intr_io)
|
|
Packit Service |
8264ee |
g_io_channel_shutdown(idev->intr_io, TRUE, NULL);
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
if (idev->ctrl_io)
|
|
Packit Service |
8264ee |
g_io_channel_shutdown(idev->ctrl_io, TRUE, NULL);
|
|
Packit Service |
8264ee |
|
|
Packit Service |
8264ee |
return 0;
|
|
Packit Service |
8264ee |
}
|