mirror of
https://git.kernel.org/pub/scm/bluetooth/bluez.git
synced 2024-11-15 00:04:29 +08:00
build: Add initial code for shared GAP handling
This commit is contained in:
Marcel Holtmann
parent
43e4419a74
commit
d4faea365e
@ -113,7 +113,8 @@ shared_sources = src/shared/io.h src/shared/timeout.h \
|
||||
src/shared/att.h src/shared/att.c \
|
||||
src/shared/gatt-helpers.h src/shared/gatt-helpers.c \
|
||||
src/shared/gatt-client.h src/shared/gatt-client.c \
|
||||
src/shared/gatt-db.h src/shared/gatt-db.c
|
||||
src/shared/gatt-db.h src/shared/gatt-db.c \
|
||||
src/shared/gap.h src/shared/gap.c
|
||||
|
||||
src_libshared_glib_la_SOURCES = $(shared_sources) \
|
||||
src/shared/io-glib.c \
|
||||
|
||||
205
src/shared/gap.c
Normal file
205
src/shared/gap.c
Normal file
@ -0,0 +1,205 @@
|
||||
/*
|
||||
*
|
||||
* BlueZ - Bluetooth protocol stack for Linux
|
||||
*
|
||||
* Copyright (C) 2012-2014 Intel Corporation. All rights reserved.
|
||||
*
|
||||
*
|
||||
* This library is free software; you can redistribute it and/or
|
||||
* modify it under the terms of the GNU Lesser General Public
|
||||
* License as published by the Free Software Foundation; either
|
||||
* version 2.1 of the License, or (at your option) any later version.
|
||||
*
|
||||
* This library is distributed in the hope that it will be useful,
|
||||
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
||||
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
|
||||
* Lesser General Public License for more details.
|
||||
*
|
||||
* You should have received a copy of the GNU Lesser General Public
|
||||
* License along with this library; if not, write to the Free Software
|
||||
* Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA
|
||||
*
|
||||
*/
|
||||
|
||||
#ifdef HAVE_CONFIG_H
|
||||
#include <config.h>
|
||||
#endif
|
||||
|
||||
#include <stdio.h>
|
||||
#include <stdlib.h>
|
||||
|
||||
#include "lib/bluetooth.h"
|
||||
#include "lib/mgmt.h"
|
||||
|
||||
#include "src/shared/util.h"
|
||||
#include "src/shared/mgmt.h"
|
||||
#include "src/shared/gap.h"
|
||||
|
||||
#define FLAG_MGMT_CONN_CONTROL (0 << 1)
|
||||
|
||||
struct bt_gap {
|
||||
int ref_count;
|
||||
struct mgmt *mgmt;
|
||||
|
||||
uint8_t mgmt_version;
|
||||
uint16_t mgmt_revision;
|
||||
bool mgmt_ready;
|
||||
|
||||
unsigned long flags;
|
||||
|
||||
bt_gap_ready_func_t ready_handler;
|
||||
bt_gap_destroy_func_t ready_destroy;
|
||||
void *ready_data;
|
||||
};
|
||||
|
||||
static void ready_status(struct bt_gap *gap, bool status)
|
||||
{
|
||||
gap->mgmt_ready = status;
|
||||
|
||||
if (gap->ready_handler)
|
||||
gap->ready_handler(status, gap->ready_data);
|
||||
}
|
||||
|
||||
static void read_commands_complete(uint8_t status, uint16_t length,
|
||||
const void *param, void *user_data)
|
||||
{
|
||||
struct bt_gap *gap = user_data;
|
||||
const struct mgmt_rp_read_commands *rp = param;
|
||||
uint16_t num_commands, num_events;
|
||||
const uint16_t *opcode;
|
||||
size_t expected_len;
|
||||
int i;
|
||||
|
||||
if (status != MGMT_STATUS_SUCCESS) {
|
||||
ready_status(gap, false);
|
||||
return;
|
||||
}
|
||||
|
||||
if (length < sizeof(*rp)) {
|
||||
ready_status(gap, false);
|
||||
return;
|
||||
}
|
||||
|
||||
num_commands = le16_to_cpu(rp->num_commands);
|
||||
num_events = le16_to_cpu(rp->num_events);
|
||||
|
||||
expected_len = sizeof(*rp) + num_commands * sizeof(uint16_t) +
|
||||
num_events * sizeof(uint16_t);
|
||||
|
||||
if (length < expected_len) {
|
||||
ready_status(gap, false);
|
||||
return;
|
||||
}
|
||||
|
||||
opcode = rp->opcodes;
|
||||
|
||||
for (i = 0; i < num_commands; i++) {
|
||||
uint16_t op = get_le16(opcode++);
|
||||
|
||||
if (op == MGMT_OP_ADD_DEVICE)
|
||||
gap->flags |= FLAG_MGMT_CONN_CONTROL;
|
||||
}
|
||||
|
||||
ready_status(gap, true);
|
||||
}
|
||||
|
||||
static void read_version_complete(uint8_t status, uint16_t length,
|
||||
const void *param, void *user_data)
|
||||
{
|
||||
struct bt_gap *gap = user_data;
|
||||
const struct mgmt_rp_read_version *rp = param;
|
||||
|
||||
if (status != MGMT_STATUS_SUCCESS) {
|
||||
ready_status(gap, false);
|
||||
return;
|
||||
}
|
||||
|
||||
if (length < sizeof(*rp)) {
|
||||
ready_status(gap, false);
|
||||
return;
|
||||
}
|
||||
|
||||
gap->mgmt_version = rp->version;
|
||||
gap->mgmt_revision = le16_to_cpu(rp->revision);
|
||||
|
||||
if (!mgmt_send(gap->mgmt, MGMT_OP_READ_COMMANDS,
|
||||
MGMT_INDEX_NONE, 0, NULL,
|
||||
read_commands_complete, gap, NULL)) {
|
||||
ready_status(gap, false);
|
||||
return;
|
||||
}
|
||||
}
|
||||
|
||||
struct bt_gap *bt_gap_new(void)
|
||||
{
|
||||
struct bt_gap *gap;
|
||||
|
||||
gap = new0(struct bt_gap, 1);
|
||||
if (!gap)
|
||||
return NULL;
|
||||
|
||||
gap->mgmt = mgmt_new_default();
|
||||
if (!gap->mgmt) {
|
||||
free(gap);
|
||||
return NULL;
|
||||
}
|
||||
|
||||
gap->mgmt_ready = false;
|
||||
|
||||
if (!mgmt_send(gap->mgmt, MGMT_OP_READ_VERSION,
|
||||
MGMT_INDEX_NONE, 0, NULL,
|
||||
read_version_complete, gap, NULL)) {
|
||||
mgmt_unref(gap->mgmt);
|
||||
return NULL;
|
||||
}
|
||||
|
||||
return bt_gap_ref(gap);
|
||||
}
|
||||
|
||||
struct bt_gap *bt_gap_ref(struct bt_gap *gap)
|
||||
{
|
||||
if (!gap)
|
||||
return NULL;
|
||||
|
||||
__sync_fetch_and_add(&gap->ref_count, 1);
|
||||
|
||||
return gap;
|
||||
}
|
||||
|
||||
void bt_gap_unref(struct bt_gap *gap)
|
||||
{
|
||||
if (!gap)
|
||||
return;
|
||||
|
||||
if (__sync_sub_and_fetch(&gap->ref_count, 1))
|
||||
return;
|
||||
|
||||
gap->mgmt_ready = false;
|
||||
|
||||
mgmt_cancel_all(gap->mgmt);
|
||||
mgmt_unregister_all(gap->mgmt);
|
||||
|
||||
if (gap->ready_destroy)
|
||||
gap->ready_destroy(gap->ready_data);
|
||||
|
||||
mgmt_unref(gap->mgmt);
|
||||
|
||||
free(gap);
|
||||
}
|
||||
|
||||
bool bt_gap_set_ready_handler(struct bt_gap *gap,
|
||||
bt_gap_ready_func_t handler, void *user_data,
|
||||
bt_gap_destroy_func_t destroy)
|
||||
{
|
||||
if (!gap)
|
||||
return false;
|
||||
|
||||
if (gap->ready_destroy)
|
||||
gap->ready_destroy(gap->ready_data);
|
||||
|
||||
gap->ready_handler = handler;
|
||||
gap->ready_destroy = destroy;
|
||||
gap->ready_data = user_data;
|
||||
|
||||
return true;
|
||||
}
|
||||
38
src/shared/gap.h
Normal file
38
src/shared/gap.h
Normal file
@ -0,0 +1,38 @@
|
||||
/*
|
||||
*
|
||||
* BlueZ - Bluetooth protocol stack for Linux
|
||||
*
|
||||
* Copyright (C) 2012-2014 Intel Corporation. All rights reserved.
|
||||
*
|
||||
*
|
||||
* This library is free software; you can redistribute it and/or
|
||||
* modify it under the terms of the GNU Lesser General Public
|
||||
* License as published by the Free Software Foundation; either
|
||||
* version 2.1 of the License, or (at your option) any later version.
|
||||
*
|
||||
* This library is distributed in the hope that it will be useful,
|
||||
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
||||
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
|
||||
* Lesser General Public License for more details.
|
||||
*
|
||||
* You should have received a copy of the GNU Lesser General Public
|
||||
* License along with this library; if not, write to the Free Software
|
||||
* Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA
|
||||
*
|
||||
*/
|
||||
|
||||
#include <stdbool.h>
|
||||
|
||||
struct bt_gap;
|
||||
|
||||
struct bt_gap *bt_gap_new(void);
|
||||
|
||||
struct bt_gap *bt_gap_ref(struct bt_gap *gap);
|
||||
void bt_gap_unref(struct bt_gap *gap);
|
||||
|
||||
typedef void (*bt_gap_destroy_func_t)(void *user_data);
|
||||
typedef void (*bt_gap_ready_func_t)(bool success, void *user_data);
|
||||
|
||||
bool bt_gap_set_ready_handler(struct bt_gap *gap,
|
||||
bt_gap_ready_func_t handler, void *user_data,
|
||||
bt_gap_destroy_func_t destroy);
|
||||
Loading…
Reference in New Issue
Block a user