Return-Path: From: Lukasz Rymanowski To: linux-bluetooth@vger.kernel.org Cc: szymon.janc@tieto.com, Lukasz Rymanowski Subject: [PATCH 23/36] shared/gatt: Add support to read from database Date: Tue, 29 Apr 2014 03:14:54 +0200 Message-Id: <1398734107-4793-25-git-send-email-lukasz.rymanowski@tieto.com> In-Reply-To: <1398734107-4793-1-git-send-email-lukasz.rymanowski@tieto.com> References: <1398734107-4793-1-git-send-email-lukasz.rymanowski@tieto.com> Sender: linux-bluetooth-owner@vger.kernel.org List-ID: --- src/shared/gatt-db.c | 35 +++++++++++++++++++++++++++++++++++ src/shared/gatt-db.h | 3 +++ 2 files changed, 38 insertions(+) diff --git a/src/shared/gatt-db.c b/src/shared/gatt-db.c index b716ae6..42b0903 100644 --- a/src/shared/gatt-db.c +++ b/src/shared/gatt-db.c @@ -671,3 +671,38 @@ void gatt_db_find_information(struct gatt_db *db, uint16_t start_handle, queue_foreach(db->services, find_information, &data); } + +static bool find_service_for_handle(const void *data, const void *user_data) +{ + const struct gatt_db_service *service = data; + uint16_t handle = PTR_TO_INT(user_data); + uint16_t start, end; + + start = service->attributes[0]->handle; + end = start + service->num_handles; + + return (start <= handle) && (handle < end); +} + +bool gatt_db_read(struct gatt_db *db, uint16_t handle, uint16_t offset, + void *req_data) +{ + struct gatt_db_service *service; + uint16_t service_handle; + struct gatt_db_attribute *a; + + service = queue_find(db->services, find_service_for_handle, + INT_TO_PTR(handle)); + if (!service) + return false; + + service_handle = service->attributes[0]->handle; + + a = service->attributes[handle - service_handle]; + if (!a || !a->read_func) + return false; + + a->read_func(handle, offset, req_data, a->user_data); + + return true; +} diff --git a/src/shared/gatt-db.h b/src/shared/gatt-db.h index a6da4e2..b63d1f6 100644 --- a/src/shared/gatt-db.h +++ b/src/shared/gatt-db.h @@ -103,3 +103,6 @@ struct gatt_db_find_information { void gatt_db_find_information(struct gatt_db *db, uint16_t start_handle, uint16_t end_handle, struct queue *queue); + +bool gatt_db_read(struct gatt_db *db, uint16_t handle, uint16_t offset, + void *req_data); -- 1.8.4