Return-Path: From: Luiz Augusto von Dentz To: linux-bluetooth@vger.kernel.org Subject: [PATCH BlueZ v4 9/9] shared/gatt-db: Add gatt_db_attribute_write Date: Fri, 31 Oct 2014 15:39:54 +0200 Message-Id: <1414762794-30166-9-git-send-email-luiz.dentz@gmail.com> In-Reply-To: <1414762794-30166-1-git-send-email-luiz.dentz@gmail.com> References: <1414762794-30166-1-git-send-email-luiz.dentz@gmail.com> Sender: linux-bluetooth-owner@vger.kernel.org List-ID: From: Luiz Augusto von Dentz --- src/shared/gatt-db.c | 27 ++++++++++++++++++++++++++- 1 file changed, 26 insertions(+), 1 deletion(-) diff --git a/src/shared/gatt-db.c b/src/shared/gatt-db.c index f6ce5f3..5855f5d 100644 --- a/src/shared/gatt-db.c +++ b/src/shared/gatt-db.c @@ -944,5 +944,30 @@ bool gatt_db_attribute_write(struct gatt_db_attribute *attrib, uint16_t offset, gatt_db_attribute_write_t func, void *user_data) { - return false; + if (!attrib || !func) + return false; + + if (attrib->write_func) { + attrib->write_func(attrib->handle, offset, value, len, opcode, + bdaddr, attrib->user_data); + return true; + } + + /* For values stored in db allocate on demand */ + if (!attrib->value || offset >= attrib->value_len || + len > (unsigned) (attrib->value_len - offset)) { + attrib->value = realloc(attrib->value, len + offset); + if (!attrib->value) + return false; + /* Init data in the first allocation */ + if (!attrib->value_len) + memset(attrib->value, 0, offset); + attrib->value_len = len + offset; + } + + memcpy(&attrib->value[offset], value, len); + + func(attrib, 0, user_data); + + return true; } -- 1.9.3