static gboolean get_adapter_and_device(bdaddr_t *src, bdaddr_t *dst,
struct btd_adapter **adapter,
struct btd_device **device,
gboolean create)
{
char peer_addr[18];
*adapter = manager_find_adapter(src);
if (!*adapter) {
error("Unable to find matching adapter");
return FALSE;
}
ba2str(dst, peer_addr);
if (create)
*device = adapter_get_device(connection, *adapter, peer_addr);
else
*device = adapter_find_device(*adapter, peer_addr);
if (create && !*device) {
error("Unable to get device object!");
return FALSE;
}
return TRUE;
}
static struct btd_device *device_for_connection(const bdaddr_t *src,
const bdaddr_t *dst)
{
struct btd_adapter *adapter;
struct btd_device *device;
char sstr[18];
char dstr[18];
ba2str(src, sstr);
ba2str(dst, dstr);
adapter = manager_find_adapter(src);
if (adapter == NULL) {
DBG("No adapter for address %s.", sstr);
return NULL;
}
DBG("Adapter found.");
device = adapter_find_device(adapter, dstr);
if (device == NULL) {
DBG("No device for address %s.", dstr);
return NULL;
}
return device;
}
static void avctp_confirm_cb(GIOChannel *chan, gpointer data)
{
struct avctp *session;
struct audio_device *dev;
char address[18];
bdaddr_t src, dst;
GError *err = NULL;
uint16_t psm;
struct btd_device *device;
bt_io_get(chan, &err,
BT_IO_OPT_SOURCE_BDADDR, &src,
BT_IO_OPT_DEST_BDADDR, &dst,
BT_IO_OPT_DEST, address,
BT_IO_OPT_PSM, &psm,
BT_IO_OPT_INVALID);
if (err) {
error("%s", err->message);
g_error_free(err);
g_io_channel_shutdown(chan, TRUE, NULL);
return;
}
DBG("AVCTP: incoming connect from %s", address);
device = adapter_find_device(adapter_find(&src), &dst);
if (!device)
return;
session = avctp_get_internal(device);
if (session == NULL)
return;
dev = manager_get_audio_device(device, TRUE);
if (!dev) {
error("Unable to get audio device object for %s", address);
goto drop;
}
if (dev->control == NULL) {
btd_device_add_uuid(dev->btd_dev, AVRCP_REMOTE_UUID);
if (dev->control == NULL)
goto drop;
}
switch (psm) {
case AVCTP_CONTROL_PSM:
avctp_control_confirm(session, chan, dev);
break;
case AVCTP_BROWSING_PSM:
avctp_browsing_confirm(session, chan, dev);
break;
}
return;
drop:
if (psm == AVCTP_CONTROL_PSM)
avctp_set_state(session, AVCTP_STATE_DISCONNECTED);
}
static void avctp_confirm_cb(GIOChannel *chan, gpointer data)
{
struct avctp *session;
char address[18];
bdaddr_t src, dst;
GError *err = NULL;
uint16_t psm;
struct btd_device *device;
bt_io_get(chan, &err,
BT_IO_OPT_SOURCE_BDADDR, &src,
BT_IO_OPT_DEST_BDADDR, &dst,
BT_IO_OPT_DEST, address,
BT_IO_OPT_PSM, &psm,
BT_IO_OPT_INVALID);
if (err) {
error("%s", err->message);
g_error_free(err);
g_io_channel_shutdown(chan, TRUE, NULL);
return;
}
DBG("AVCTP: incoming connect from %s", address);
device = adapter_find_device(adapter_find(&src), &dst);
if (!device)
return;
session = avctp_get_internal(device);
if (session == NULL)
return;
if (btd_device_get_service(device, AVRCP_REMOTE_UUID) == NULL)
btd_device_add_uuid(device, AVRCP_REMOTE_UUID);
if (btd_device_get_service(device, AVRCP_TARGET_UUID) == NULL)
btd_device_add_uuid(device, AVRCP_TARGET_UUID);
switch (psm) {
case AVCTP_CONTROL_PSM:
avctp_control_confirm(session, chan, device);
break;
case AVCTP_BROWSING_PSM:
avctp_browsing_confirm(session, chan, device);
break;
}
return;
}
static struct input_device *find_device(const bdaddr_t *src,
const bdaddr_t *dst)
{
struct btd_device *device;
struct btd_service *service;
device = adapter_find_device(adapter_find(src), dst);
if (device == NULL)
return NULL;
service = btd_device_get_service(device, HID_UUID);
if (service == NULL)
return NULL;
return btd_service_get_user_data(service);
}
static struct btd_device *get_notifiable_device(struct btd_adapter *adapter,
char *key, char *value,
uint16_t ccc)
{
struct btd_device *device;
char addr[18];
uint16_t hnd, val;
uint8_t bdaddr_type;
sscanf(key, "%17s#%hhu#%04hX", addr, &bdaddr_type, &hnd);
if (hnd != ccc)
return NULL;
val = strtol(value, NULL, 16);
if (!(val & 0x0001))
return NULL;
device = adapter_find_device(adapter, addr);
if (device == NULL)
return NULL;
return btd_device_ref(device);
}
