On Thursday 10 of July 2014 16:30:32 Szymon Janc wrote:
> This adds listening on both LE and BR/EDR and SDP records for GAP,
> GATT and DIS.
> ---
> android/gatt.c | 243
> +++++++++++++++++++++++++++++++++++++++++++++------------ 1 file changed,
> 193 insertions(+), 50 deletions(-)
>
> diff --git a/android/gatt.c b/android/gatt.c
> index 1e2366d..e07226c 100644
> --- a/android/gatt.c
> +++ b/android/gatt.c
> @@ -35,6 +35,7 @@
> #include "ipc.h"
> #include "ipc-common.h"
> #include "lib/sdp.h"
> +#include "lib/sdp_lib.h"
> #include "lib/uuid.h"
> #include "bluetooth.h"
> #include "gatt.h"
> @@ -190,7 +191,12 @@ static struct gatt_db *gatt_db = NULL;
>
> static uint16_t service_changed_handle = 0;
>
> -static GIOChannel *listening_io = NULL;
> +static GIOChannel *le_io = NULL;
> +static GIOChannel *bredr_io = NULL;
> +
> +static uint32_t gatt_sdp_handle = 0;
> +static uint32_t gap_sdp_handle = 0;
> +static uint32_t dis_sdp_handle = 0;
>
> static struct bt_crypto *crypto = NULL;
>
> @@ -4742,6 +4748,93 @@ static void notify_service_change(void *data, void
> *user_data) notify_att_range_change(data, &range);
> }
>
> +static sdp_record_t *get_sdp_record(uuid_t *uuid, uint16_t start, uint16_t
> end, + const char *name)
> +{
> + sdp_list_t *svclass_id, *apseq, *proto[2], *root, *aproto;
> + uuid_t root_uuid, proto_uuid, l2cap;
> + sdp_record_t *record;
> + sdp_data_t *psm, *sh, *eh;
> + uint16_t lp = ATT_PSM;
> +
> + record = sdp_record_alloc();
> + if (record == NULL)
> + return NULL;
> +
> + sdp_uuid16_create(&root_uuid, PUBLIC_BROWSE_GROUP);
> + root = sdp_list_append(NULL, &root_uuid);
> + sdp_set_browse_groups(record, root);
> + sdp_list_free(root, NULL);
> +
> + svclass_id = sdp_list_append(NULL, uuid);
> + sdp_set_service_classes(record, svclass_id);
> + sdp_list_free(svclass_id, NULL);
> +
> + sdp_uuid16_create(&l2cap, L2CAP_UUID);
> + proto[0] = sdp_list_append(NULL, &l2cap);
> + psm = sdp_data_alloc(SDP_UINT16, &lp);
> + proto[0] = sdp_list_append(proto[0], psm);
> + apseq = sdp_list_append(NULL, proto[0]);
> +
> + sdp_uuid16_create(&proto_uuid, ATT_UUID);
> + proto[1] = sdp_list_append(NULL, &proto_uuid);
> + sh = sdp_data_alloc(SDP_UINT16, &start);
> + proto[1] = sdp_list_append(proto[1], sh);
> + eh = sdp_data_alloc(SDP_UINT16, &end);
> + proto[1] = sdp_list_append(proto[1], eh);
> + apseq = sdp_list_append(apseq, proto[1]);
> +
> + aproto = sdp_list_append(NULL, apseq);
> + sdp_set_access_protos(record, aproto);
> +
> + if (name)
> + sdp_set_info_attr(record, name, "BlueZ for Android", NULL);
> +
> + sdp_data_free(psm);
> + sdp_data_free(sh);
> + sdp_data_free(eh);
> + sdp_list_free(proto[0], NULL);
> + sdp_list_free(proto[1], NULL);
> + sdp_list_free(apseq, NULL);
> + sdp_list_free(aproto, NULL);
> +
> + return record;
> +}
> +
> +static uint32_t add_sdp_record(const bt_uuid_t *uuid, uint16_t start,
> + uint16_t end, const char *name)
> +{
> + sdp_record_t *rec;
> + uuid_t u, u32;
> +
> + switch (uuid->type) {
> + case BT_UUID16:
> + sdp_uuid16_create(&u, uuid->value.u16);
> + break;
> + case BT_UUID32:
> + sdp_uuid32_create(&u32, uuid->value.u32);
> + sdp_uuid32_to_uuid128(&u, &u32);
> + break;
> + case BT_UUID128:
> + sdp_uuid128_create(&u, &uuid->value.u128);
> + break;
> + default:
> + return 0;
> + }
> +
> + rec = get_sdp_record(&u, start, end, name);
> + if (!rec)
> + return 0;
> +
> + if (bt_adapter_add_record(rec, 0) < 0) {
> + error("gatt: Failed to register SDP record");
> + sdp_record_free(rec);
> + return 0;
> + }
> +
> + return rec->handle;
> +}
> +
> static void handle_server_start_service(const void *buf, uint16_t len)
> {
> const struct hal_cmd_gatt_server_start_service *cmd = buf;
> @@ -5884,6 +5977,7 @@ done:
>
> static void register_gap_service(void)
> {
> + uint16_t start, end;
> bt_uuid_t uuid;
>
> /* GAP UUID */
> @@ -5918,6 +6012,14 @@ static void register_gap_service(void)
> NULL);
>
> gatt_db_service_set_active(gatt_db, gap_srvc_data.srvc , true);
> +
> + /* SDP */
> + start = gap_srvc_data.srvc;
> + end = gatt_db_get_end_handle(gatt_db, gap_srvc_data.srvc);
> + gap_sdp_handle = add_sdp_record(&uuid, start, end,
> + "Generic Access Profile");
> + if (!gap_sdp_handle)
> + error("gatt: Failed to register GAP SDP record");
> }
>
> /* TODO: Get those data from device possible via androig/bluetooth.c */
> @@ -5973,7 +6075,7 @@ done:
> static void register_device_info_service(void)
> {
> bt_uuid_t uuid;
> - uint16_t srvc_handle;
> + uint16_t srvc_handle, end_handle;
>
> DBG("");
>
> @@ -6019,6 +6121,13 @@ static void register_device_info_service(void)
> (void *) device_info.manufacturer_name);
>
> gatt_db_service_set_active(gatt_db, srvc_handle, true);
> +
> + /* SDP */
> + end_handle = gatt_db_get_end_handle(gatt_db, srvc_handle);
> + dis_sdp_handle = add_sdp_record(&uuid, srvc_handle, end_handle,
> + "Device Information Service");
> + if (!dis_sdp_handle)
> + error("gatt: Failed to register DIS SDP record");
> }
>
> static void gatt_srvc_change_write_cb(uint16_t handle, uint16_t offset,
> @@ -6087,8 +6196,8 @@ static void gatt_srvc_change_read_cb(uint16_t handle,
> uint16_t offset,
>
> static void register_gatt_service(void)
> {
> + uint16_t srvc_handle, end_handle;
> bt_uuid_t uuid;
> - uint16_t srvc_handle;
>
> DBG("");
>
> @@ -6108,22 +6217,34 @@ static void register_gatt_service(void)
> gatt_srvc_change_write_cb, NULL);
>
> gatt_db_service_set_active(gatt_db, srvc_handle, true);
> +
> + /* SDP */
> + end_handle = gatt_db_get_end_handle(gatt_db, srvc_handle);
> + gatt_sdp_handle = add_sdp_record(&uuid, srvc_handle, end_handle,
> + "Generic Attribute Profile");
> +
> + if (!gatt_sdp_handle)
> + error("gatt: Failed to register GATT SDP record");
> }
>
> -static bool start_listening_io(void)
> +static bool start_listening(void)
> {
> - GError *gerr = NULL;
> + /* BR/EDR socket */
> + bredr_io = bt_io_listen(NULL, connect_confirm, NULL, NULL, NULL,
> + BT_IO_OPT_SOURCE_TYPE, BDADDR_BREDR,
> + BT_IO_OPT_PSM, ATT_PSM,
> + BT_IO_OPT_SEC_LEVEL, BT_IO_SEC_LOW,
> + BT_IO_OPT_INVALID);
>
> - /* For now only listen on BLE */
> - listening_io = bt_io_listen(NULL, connect_confirm,
> - &listening_io, NULL, &gerr,
> + /* LE socket */
> + le_io = bt_io_listen(NULL, connect_confirm, NULL, NULL, NULL,
> BT_IO_OPT_SOURCE_TYPE, BDADDR_LE_PUBLIC,
> BT_IO_OPT_CID, ATT_CID,
> BT_IO_OPT_SEC_LEVEL, BT_IO_SEC_LOW,
> BT_IO_OPT_INVALID);
> - if (!listening_io) {
> - error("gatt: Failed to start listening IO (%s)", gerr->message);
> - g_error_free(gerr);
> +
> + if (!le_io && !bredr_io) {
> + error("gatt: Failed to start listening IO");
> return false;
> }
>
> @@ -6134,26 +6255,13 @@ bool bt_gatt_register(struct ipc *ipc, const
> bdaddr_t *addr) {
> DBG("");
>
> - if (!start_listening_io())
> - return false;
> -
> - if (!bt_le_register(le_device_found_handler)) {
> - error("gatt: bt_le_register failed");
> -
> - g_io_channel_unref(listening_io);
> - listening_io = NULL;
> -
> + if (!start_listening())
> return false;
> - }
>
> crypto = bt_crypto_new();
> if (!crypto) {
> error("gatt: Failed to setup crypto");
> -
> - g_io_channel_unref(listening_io);
> - listening_io = NULL;
> -
> - return false;
> + goto failed;
> }
>
> gatt_devices = queue_new();
> @@ -6165,28 +6273,12 @@ bool bt_gatt_register(struct ipc *ipc, const
> bdaddr_t *addr) if (!gatt_devices || !gatt_apps || !listen_apps ||
> !app_connections || !gatt_db) {
> error("gatt: Failed to allocate memory for queues");
> + goto failed;
> + }
>
> - queue_destroy(gatt_apps, NULL);
> - gatt_apps = NULL;
> -
> - queue_destroy(gatt_devices, NULL);
> - gatt_devices = NULL;
> -
> - queue_destroy(app_connections, NULL);
> - app_connections = NULL;
> -
> - queue_destroy(listen_apps, NULL);
> - listen_apps = NULL;
> -
> - gatt_db_destroy(gatt_db);
> - gatt_db = NULL;
> -
> - g_io_channel_unref(listening_io);
> - listening_io = NULL;
> -
> - bt_crypto_unref(crypto);
> -
> - return false;
> + if (!bt_le_register(le_device_found_handler)) {
> + error("gatt: bt_le_register failed");
> + goto failed;
> }
>
> bacpy(&adapter_addr, addr);
> @@ -6200,7 +6292,41 @@ bool bt_gatt_register(struct ipc *ipc, const bdaddr_t
> *addr) register_device_info_service();
> register_gatt_service();
>
> + info("gatt: LE: %s BR/EDR: %s", le_io ? "enabled" : "disabled",
> + bredr_io ? "enabled" : "disabled");
> +
> return true;
> +
> +failed:
> + queue_destroy(gatt_apps, NULL);
> + gatt_apps = NULL;
> +
> + queue_destroy(gatt_devices, NULL);
> + gatt_devices = NULL;
> +
> + queue_destroy(app_connections, NULL);
> + app_connections = NULL;
> +
> + queue_destroy(listen_apps, NULL);
> + listen_apps = NULL;
> +
> + gatt_db_destroy(gatt_db);
> + gatt_db = NULL;
> +
> + bt_crypto_unref(crypto);
> + crypto = NULL;
> +
> + if (le_io) {
> + g_io_channel_unref(le_io);
> + le_io = NULL;
> + }
> +
> + if (bredr_io) {
> + g_io_channel_unref(bredr_io);
> + bredr_io = NULL;
> + }
> +
> + return false;
> }
>
> void bt_gatt_unregister(void)
> @@ -6225,8 +6351,26 @@ void bt_gatt_unregister(void)
> gatt_db_destroy(gatt_db);
> gatt_db = NULL;
>
> - g_io_channel_unref(listening_io);
> - listening_io = NULL;
> + g_io_channel_unref(le_io);
> + le_io = NULL;
> +
> + g_io_channel_unref(bredr_io);
> + bredr_io = NULL;
> +
> + if (gap_sdp_handle) {
> + bt_adapter_remove_record(gap_sdp_handle);
> + gap_sdp_handle = 0;
> + }
> +
> + if (gatt_sdp_handle) {
> + bt_adapter_remove_record(gatt_sdp_handle);
> + gatt_sdp_handle = 0;
> + }
> +
> + if (dis_sdp_handle) {
> + bt_adapter_remove_record(dis_sdp_handle);
> + dis_sdp_handle = 0;
> + }
>
> bt_crypto_unref(crypto);
> crypto = NULL;
> @@ -6234,7 +6378,6 @@ void bt_gatt_unregister(void)
> bt_le_unregister();
> }
>
> -
> unsigned int bt_gatt_register_app(const char *uuid, gatt_type_t type,
> gatt_conn_cb_t func)
> {
Pushed.
--
BR
Szymon Janc
--
To unsubscribe from this list: send the line "unsubscribe linux-bluetooth" in
the body of a message to majordomo@xxxxxxxxxxxxxxx
More majordomo info at http://vger.kernel.org/majordomo-info.html
