Return-Path: From: Lukasz Rymanowski To: linux-bluetooth@vger.kernel.org Cc: szymon.janc@tieto.com, johan.hedberg@gmail.com, Lukasz Rymanowski Subject: [PATCH v4 32/38] android/gatt: Add support for write request Date: Wed, 30 Apr 2014 11:14:03 +0200 Message-Id: <1398849249-5868-33-git-send-email-lukasz.rymanowski@tieto.com> In-Reply-To: <1398849249-5868-1-git-send-email-lukasz.rymanowski@tieto.com> References: <1398849249-5868-1-git-send-email-lukasz.rymanowski@tieto.com> Sender: linux-bluetooth-owner@vger.kernel.org List-ID: This patch add support for write request, command and prepare write --- android/gatt.c | 49 +++++++++++++++++++++++++++++++++++++++++++++++-- 1 file changed, 47 insertions(+), 2 deletions(-) diff --git a/android/gatt.c b/android/gatt.c index dfe7dec..785e6d2 100644 --- a/android/gatt.c +++ b/android/gatt.c @@ -3892,6 +3892,47 @@ static uint8_t find_info_handle(const uint8_t *cmd, uint16_t cmd_len, return 0; } +static uint8_t write_request(const uint8_t *cmd, uint16_t cmd_len, + struct gatt_device *dev) +{ + uint16_t handle; + uint16_t offset = 0; + uint16_t len; + uint8_t value[ATT_DEFAULT_LE_MTU]; + size_t vlen; + + switch (cmd[0]) { + case ATT_OP_WRITE_CMD: + len = dec_write_cmd(cmd, cmd_len, &handle, value, &vlen); + if (!len) + return ATT_ECODE_INVALID_PDU; + + break; + case ATT_OP_WRITE_REQ: + len = dec_write_req(cmd, cmd_len, &handle, value, &vlen); + if (!len) + return ATT_ECODE_INVALID_PDU; + + break; + case ATT_OP_PREP_WRITE_REQ: + len = dec_prep_write_req(cmd, cmd_len, &handle, &offset, + value, &vlen); + if (!len) + return ATT_ECODE_INVALID_PDU; + + break; + default: + error("gatt: Unexpected write type 0x02%x", cmd[0]); + return ATT_ECODE_REQ_NOT_SUPP; + } + + if (!gatt_db_write(gatt_db, handle, offset, value, vlen, cmd[0], + &dev->bdaddr)) + return ATT_ECODE_UNLIKELY; + + return 0; +} + static void att_handler(const uint8_t *ipdu, uint16_t len, gpointer user_data) { struct gatt_device *dev = user_data; @@ -3934,13 +3975,17 @@ static void att_handler(const uint8_t *ipdu, uint16_t len, gpointer user_data) break; case ATT_OP_WRITE_REQ: case ATT_OP_WRITE_CMD: + case ATT_OP_PREP_WRITE_REQ: + status = write_request(ipdu, len, dev); + if (!status) + return; + break; + case ATT_OP_EXEC_WRITE_REQ: case ATT_OP_FIND_BY_TYPE_REQ: case ATT_OP_HANDLE_CNF: case ATT_OP_HANDLE_IND: case ATT_OP_HANDLE_NOTIFY: case ATT_OP_READ_MULTI_REQ: - case ATT_OP_PREP_WRITE_REQ: - case ATT_OP_EXEC_WRITE_REQ: default: DBG("Unsupported request 0x%02x", ipdu[0]); status = ATT_ECODE_REQ_NOT_SUPP; -- 1.8.4