Return-Path: From: Marcin Kraglak To: linux-bluetooth@vger.kernel.org Subject: [RFC 03/16] gatt: Add method for creating services in gatt_db Date: Wed, 9 Apr 2014 09:07:01 +0200 Message-Id: <1397027234-12003-4-git-send-email-marcin.kraglak@tieto.com> In-Reply-To: <1397027234-12003-1-git-send-email-marcin.kraglak@tieto.com> References: <1397027234-12003-1-git-send-email-marcin.kraglak@tieto.com> Sender: linux-bluetooth-owner@vger.kernel.org List-ID: This function will reserve number of handles and create service attribute. Allowed service types are PRIMARY and SECONDARY. --- src/shared/gatt-db.c | 92 ++++++++++++++++++++++++++++++++++++++++++++++++++++ src/shared/gatt-db.h | 9 +++++ 2 files changed, 101 insertions(+) diff --git a/src/shared/gatt-db.c b/src/shared/gatt-db.c index 47915c7..15e2f95 100644 --- a/src/shared/gatt-db.c +++ b/src/shared/gatt-db.c @@ -23,16 +23,26 @@ #include +#include "lib/uuid.h" #include "src/shared/util.h" #include "src/shared/queue.h" #include "src/shared/gatt-db.h" +static const bt_uuid_t primary_service_uuid = { .type = BT_UUID16, + .value.u16 = GATT_PRIM_SVC_UUID }; +static const bt_uuid_t secondary_service_uuid = { .type = BT_UUID16, + .value.u16 = GATT_SND_SVC_UUID }; + struct gatt_db { uint16_t next_handle; struct queue *services; }; struct gatt_db_attribute { + uint16_t handle; + bt_uuid_t uuid; + uint16_t val_len; + uint8_t value[0]; }; struct gatt_db_service { @@ -77,3 +87,85 @@ void gatt_db_destroy(struct gatt_db *db) queue_destroy(db->services, gatt_db_service_destroy); free(db); } + +static struct gatt_db_attribute *new_attribute(const bt_uuid_t *type, + const uint8_t *val, + uint16_t len) +{ + struct gatt_db_attribute *attribute; + + attribute = malloc0(sizeof(struct gatt_db_attribute) + len); + if (!attribute) + return NULL; + + attribute->uuid = *type; + memcpy(&attribute->value, val, len); + attribute->val_len = len; + + return attribute; +} + +static int uuid_to_le(const bt_uuid_t *uuid, uint8_t *dst) +{ + switch (uuid->type) { + case BT_UUID16: + put_le16(uuid->value.u16, dst); + break; + case BT_UUID32: + put_le32(uuid->value.u32, dst); + break; + default: + bswap_128(&uuid->value.u128, dst); + break; + } + + return bt_uuid_len(uuid); +} + +uint16_t gatt_db_new_service(struct gatt_db *db, const bt_uuid_t *uuid, + enum gatt_db_service_type service_type, + uint16_t num_handles) +{ + struct gatt_db_service *service; + const bt_uuid_t *type; + uint8_t value[16]; + uint16_t len; + + service = new0(struct gatt_db_service, 1); + if (!service) + return 0; + + service->attributes = new0(struct gatt_db_attribute *, num_handles); + if (!service->attributes) { + free(service); + return 0; + } + + switch (service_type) { + case GATT_DB_SERVICE_SECONDARY: + type = &secondary_service_uuid; + break; + default: + type = &primary_service_uuid; + break; + } + + len = uuid_to_le(uuid, value); + + service->attributes[0] = new_attribute(type, value, len); + if (!service->attributes[0]) { + gatt_db_service_destroy(service); + return 0; + } + + if (!queue_push_tail(db->services, service)) { + gatt_db_service_destroy(service); + return 0; + } + + service->attributes[0]->handle = db->next_handle; + db->next_handle += num_handles; + service->num_handles = num_handles; + + return service->attributes[0]->handle; +} diff --git a/src/shared/gatt-db.h b/src/shared/gatt-db.h index 2901afb..7c03013 100644 --- a/src/shared/gatt-db.h +++ b/src/shared/gatt-db.h @@ -23,5 +23,14 @@ struct gatt_db; +enum gatt_db_service_type { + GATT_DB_SERVICE_PRIMARY, + GATT_DB_SERVICE_SECONDARY +}; + struct gatt_db *gatt_db_new(void); void gatt_db_destroy(struct gatt_db *db); + +uint16_t gatt_db_new_service(struct gatt_db *db, const bt_uuid_t *uuid, + enum gatt_db_service_type service_type, + uint16_t num_handles); -- 1.8.5.3