X_NUCLEO_IDB05A1
Dependencies: mbed-os-example-ble-Advertising
Diff: source/BlueNRGGattServer.cpp
- Revision:
- 130:770ce14d3d15
- Child:
- 132:51056160fa4a
--- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/source/BlueNRGGattServer.cpp Tue Oct 06 14:25:08 2015 +0200 @@ -0,0 +1,443 @@ +/* mbed Microcontroller Library +* Copyright (c) 2006-2013 ARM Limited +* +* Licensed under the Apache License, Version 2.0 (the "License"); +* you may not use this file except in compliance with the License. +* You may obtain a copy of the License at +* +* http://www.apache.org/licenses/LICENSE-2.0 +* +* Unless required by applicable law or agreed to in writing, software +* distributed under the License is distributed on an "AS IS" BASIS, +* WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. +* See the License for the specific language governing permissions and +* limitations under the License. +*/ +/** + ****************************************************************************** + * @file BlueNRGGattServer.cpp + * @author STMicroelectronics + * @brief Implementation of BlueNRG BLE_API GattServer Class + ****************************************************************************** + * @copy + * + * THE PRESENT FIRMWARE WHICH IS FOR GUIDANCE ONLY AIMS AT PROVIDING CUSTOMERS + * WITH CODING INFORMATION REGARDING THEIR PRODUCTS IN ORDER FOR THEM TO SAVE + * TIME. AS A RESULT, STMICROELECTRONICS SHALL NOT BE HELD LIABLE FOR ANY + * DIRECT, INDIRECT OR CONSEQUENTIAL DAMAGES WITH RESPECT TO ANY CLAIMS ARISING + * FROM THE CONTENT OF SUCH FIRMWARE AND/OR THE USE MADE BY CUSTOMERS OF THE + * CODING INFORMATION CONTAINED HEREIN IN CONNECTION WITH THEIR PRODUCTS. + * + * <h2><center>© COPYRIGHT 2013 STMicroelectronics</center></h2> + */ + + +// ANDREA: Changed some types (e.g., tHalUint8 --> uint8_t) + +/** @defgroup BlueNRGGATTSERVER + * @brief BlueNRG BLE_API GattServer Adaptation + * @{ + */ + +#include "BlueNRGGattServer.h" +#include "mbed.h" +#include "BlueNRGGap.h" +#include "Utils.h" + +/**************************************************************************/ +/*! + @brief Adds a new service to the GATT table on the peripheral + + @params[in] service + Pointer to instance of the Gatt Server to add + + @returns ble_error_t + + @retval BLE_ERROR_NONE + Everything executed properly + + @section EXAMPLE + + @code + + @endcode +*/ +/**************************************************************************/ +ble_error_t BlueNRGGattServer::addService(GattService &service) +{ + /* ToDo: Make sure we don't overflow the array, etc. */ + /* ToDo: Make sure this service UUID doesn't already exist (?) */ + /* ToDo: Basic validation */ + + tBleStatus ret; + uint8_t type; + uint16_t short_uuid; + uint8_t primary_short_uuid[2]; + uint8_t primary_base_uuid[16]; + uint8_t char_base_uuid[16]; + const uint8_t *base_uuid; + const uint8_t *base_char_uuid; + + uint8_t charsCount = 0; + uint8_t maxAttrRecords = 0; + + type = (service.getUUID()).shortOrLong(); + DEBUG("AddService(): Type:%d\n\r", type); + + /* Add the service to the BlueNRG */ + short_uuid = (service.getUUID()).getShortUUID(); + STORE_LE_16(primary_short_uuid, short_uuid); + + if(type==UUID::UUID_TYPE_LONG) { + base_uuid = (service.getUUID()).getBaseUUID(); + + COPY_UUID_128(primary_base_uuid, base_uuid[15],base_uuid[14],base_uuid[13],base_uuid[12],base_uuid[11],base_uuid[10],base_uuid[9], + base_uuid[8],base_uuid[7],base_uuid[6],base_uuid[5],base_uuid[4],primary_short_uuid[1],primary_short_uuid[0],base_uuid[1],base_uuid[0]); + } + + charsCount = service.getCharacteristicCount(); + //1(service record)+2records*char+1record*char_desc + maxAttrRecords = 1+3*charsCount; + + if(type==UUID::UUID_TYPE_SHORT) { + ret = aci_gatt_add_serv(UUID_TYPE_16, + primary_short_uuid, + PRIMARY_SERVICE, + maxAttrRecords/*7*/, + &servHandle); + DEBUG("aci_gatt_add_serv UUID_TYPE_LONG ret=%d\n\r", ret); + } + else if(type==UUID::UUID_TYPE_LONG) { + ret = aci_gatt_add_serv(UUID_TYPE_128, + primary_base_uuid, + PRIMARY_SERVICE, + maxAttrRecords/*7*/, + &servHandle); + DEBUG("aci_gatt_add_serv UUID_TYPE_LONG ret=%d\n\r", ret); + } + + service.setHandle(servHandle); + //serviceHandleVector.push_back(servHandle); + DEBUG("added servHandle handle =%u\n\r", servHandle); + uint16_t bleCharacteristic; + + //iterate to include all characteristics + for (uint8_t i = 0; i < charsCount; i++) { + GattCharacteristic *p_char = service.getCharacteristic(i); + uint16_t char_uuid = (p_char->getValueAttribute().getUUID()).getShortUUID(); + + uint8_t int_8_uuid[2]; + STORE_LE_16(int_8_uuid, char_uuid); + + if(type==UUID::UUID_TYPE_LONG) { + base_char_uuid = (p_char->getValueAttribute().getUUID()).getBaseUUID(); + + COPY_UUID_128(char_base_uuid, base_char_uuid[15],base_char_uuid[14],base_char_uuid[13],base_char_uuid[12],base_char_uuid[11],base_char_uuid[10],base_char_uuid[9], + base_char_uuid[8],base_char_uuid[7],base_char_uuid[6],base_char_uuid[5],base_char_uuid[4],int_8_uuid[1],int_8_uuid[0],base_char_uuid[1],base_char_uuid[0]); + } + + DEBUG("Char Properties 0x%x\n\r", p_char->getProperties()); + /* + * Gatt_Evt_Mask -> HardCoded (0) + * Encryption_Key_Size -> Hardcoded (16) + * isVariable (variable length value field) -> Hardcoded (1) + */ + uint8_t Gatt_Evt_Mask = 0x0; + + if((p_char->getProperties() & + (GattCharacteristic::BLE_GATT_CHAR_PROPERTIES_WRITE_WITHOUT_RESPONSE| + GattCharacteristic::BLE_GATT_CHAR_PROPERTIES_WRITE))) { + DEBUG("Setting up Gatt GATT_NOTIFY_ATTRIBUTE_WRITE Mask\n\r"); + Gatt_Evt_Mask = Gatt_Evt_Mask | GATT_NOTIFY_ATTRIBUTE_WRITE; + } + if((p_char->getProperties() & + (GattCharacteristic::BLE_GATT_CHAR_PROPERTIES_READ| + GattCharacteristic::BLE_GATT_CHAR_PROPERTIES_NOTIFY| GattCharacteristic::BLE_GATT_CHAR_PROPERTIES_INDICATE))) { + DEBUG("Setting up Gatt GATT_NOTIFY_READ_REQ_AND_WAIT_FOR_APPL_RESP Mask\n\r"); + Gatt_Evt_Mask = Gatt_Evt_Mask | GATT_NOTIFY_READ_REQ_AND_WAIT_FOR_APPL_RESP; + } //This will support also GATT_SERVER_ATTR_READ_WRITE since it will be covered by previous if() check. + + if(type==UUID::UUID_TYPE_SHORT) { + ret = aci_gatt_add_char(service.getHandle(), + UUID_TYPE_16, + int_8_uuid, + p_char->getValueAttribute().getMaxLength() /*2*/ /*Value Length*/, + p_char->getProperties(), + ATTR_PERMISSION_NONE, + Gatt_Evt_Mask /*Gatt_Evt_Mask*/, + 16 /*Encryption_Key_Size*/, + 1 /*isVariable*/, + &bleCharacteristic); + + DEBUG("aci_gatt_add_char UUID_TYPE_16 props=%d MaxLength=%d ret=%d\n\r", p_char->getProperties(), p_char->getValueAttribute().getMaxLength(), ret); + + } else if(type==UUID::UUID_TYPE_LONG) { + ret = aci_gatt_add_char(service.getHandle(), + UUID_TYPE_128, + char_base_uuid, + p_char->getValueAttribute().getMaxLength() /*2*/ /*Value Length*/, + p_char->getProperties(), + ATTR_PERMISSION_NONE, + Gatt_Evt_Mask /*Gatt_Evt_Mask*/, + 16 /*Encryption_Key_Size*/, + 1 /*isVariable*/, + &bleCharacteristic); + + DEBUG("aci_gatt_add_char UUID_TYPE_128 props=%d MaxLength=%d ret=%d\n\r", p_char->getProperties(), p_char->getValueAttribute().getMaxLength(), ret); + } + + /* Update the characteristic handle */ + //uint16_t charHandle = characteristicCount; + + bleCharHanldeMap.insert(std::pair<uint16_t, uint16_t>(bleCharacteristic, servHandle)); + + p_characteristics[characteristicCount++] = p_char; + p_char->getValueAttribute().setHandle(bleCharacteristic); //Set the characteristic count as the corresponding char handle + DEBUG("added bleCharacteristic handle =%u\n\r", bleCharacteristic); + + if ((p_char->getValueAttribute().getValuePtr() != NULL) && (p_char->getValueAttribute().getInitialLength() > 0)) { + write(p_char->getValueAttribute().getHandle(), p_char->getValueAttribute().getValuePtr(), p_char->getValueAttribute().getInitialLength(), false /* localOnly */); + } + + // add descriptors now + uint16_t descHandle = 0; + DEBUG("p_char->getDescriptorCount()=%d\n\r", p_char->getDescriptorCount()); + + for(uint8_t descIndex=0; descIndex<p_char->getDescriptorCount(); descIndex++) { + GattAttribute *descriptor = p_char->getDescriptor(descIndex); + uint16_t shortUUID = descriptor->getUUID().getShortUUID(); + const uint8_t uuidArray[] = {(uint8_t)((shortUUID>>8)&0xFF), (uint8_t)((shortUUID&0xFF))}; + ret = aci_gatt_add_char_desc(service.getHandle(), p_char->getValueAttribute().getHandle(), + CHAR_DESC_TYPE_16_BIT, uuidArray, descriptor->getMaxLength(), descriptor->getInitialLength(), + descriptor->getValuePtr(), CHAR_DESC_SECURITY_PERMISSION, CHAR_DESC_ACCESS_PERMISSION, GATT_NOTIFY_ATTRIBUTE_WRITE, + MIN_ENCRY_KEY_SIZE, CHAR_ATTRIBUTE_LEN_IS_FIXED, &descHandle); + DEBUG("Adding Descriptor descriptor handle=%d ret=%d\n\r", descHandle, ret); + if(ret==(tBleStatus)0) { + DEBUG("Descriptor added successfully, descriptor handle=%d\n\r", descHandle); + descriptor->setHandle(descHandle); + } + } + + } + + serviceCount++; + + //FIXME: There is no GattService pointer array in GattServer. + // There should be one? (Only the user is aware of GattServices!) Report to forum. + + return BLE_ERROR_NONE; +} + +/**************************************************************************/ +/*! + @brief Reads the value of a characteristic, based on the service + and characteristic index fields + + @param[in] charHandle + The handle of the GattCharacteristic to read from + @param[in] buffer + Buffer to hold the the characteristic's value + (raw byte array in LSB format) + @param[in] lengthP + The number of bytes read into the buffer + + @returns ble_error_t + + @retval BLE_ERROR_NONE + Everything executed properly + + @section EXAMPLE + + @code + + @endcode +*/ +/**************************************************************************/ +ble_error_t BlueNRGGattServer::readValue(uint16_t charHandle, uint8_t buffer[], uint16_t *const lengthP) +{ + DEBUG("ReadValue() Not Supported\n\r"); + return BLE_ERROR_NONE; +} + +/**************************************************************************/ +/*! + @brief Updates the value of a characteristic, based on the service + and characteristic index fields + + @param[in] charHandle + The handle of the GattCharacteristic to write to + @param[in] buffer + Data to use when updating the characteristic's value + (raw byte array in LSB format) + @param[in] len + The number of bytes in buffer + + @returns ble_error_t + + @retval BLE_ERROR_NONE + Everything executed properly + + @section EXAMPLE + + @code + + @endcode +*/ +/**************************************************************************/ +// <<<ANDREA>>> +ble_error_t BlueNRGGattServer::readValue(Gap::Handle_t connectionHandle, GattAttribute::Handle_t attributeHandle, uint8_t buffer[], uint16_t *lengthP) { + // Empty by now + return BLE_ERROR_NONE; +} + +ble_error_t BlueNRGGattServer::write(Gap::Handle_t connectionHandle, GattAttribute::Handle_t, const uint8_t[], uint16_t, bool localOnly) { + // Empty by now + return BLE_ERROR_NONE; +} + +ble_error_t BlueNRGGattServer::write(GattAttribute::Handle_t charHandle, const uint8_t buffer[], uint16_t len, bool localOnly) +{ + tBleStatus ret; + //uint8_t buff[2]; + + DEBUG("updating bleCharacteristic charHandle =%u, corresponding serviceHanle= %u len=%d\n\r", charHandle, bleCharHanldeMap.find(charHandle)->second, len); + /* + for(int i=0; i<len; i++) { + DEBUG("buffer[%d]=%d\n\r", i, buffer[i]); + } + */ + ret = aci_gatt_update_char_value(bleCharHanldeMap.find(charHandle)->second, charHandle, 0, len, buffer); + + if (ret != BLE_STATUS_SUCCESS){ + DEBUG("Error while updating characteristic (ret=0x%x).\n\r", ret) ; + return BLE_ERROR_PARAM_OUT_OF_RANGE ; //Not correct Error Value + //FIXME: Define Error values equivalent to BlueNRG Error Codes. + } + + //Generate Data Sent Event Here? (GattServerEvents::GATT_EVENT_DATA_SENT) //FIXME: Is this correct? + //Check if characteristic property is NOTIFY|INDICATE, if yes generate event + GattCharacteristic *p_char = BlueNRGGattServer::getInstance().getCharacteristicFromHandle(charHandle); + if(p_char->getProperties() & (GattCharacteristic::BLE_GATT_CHAR_PROPERTIES_NOTIFY + | GattCharacteristic::BLE_GATT_CHAR_PROPERTIES_INDICATE)) { + DEBUG("Generate event after updating\n\r"); + BlueNRGGattServer::getInstance().handleEvent(GattServerEvents::GATT_EVENT_DATA_SENT, charHandle); + } + + return BLE_ERROR_NONE; +} + +/**************************************************************************/ +/*! + @brief Reads a value according to the handle provided + + @param[in] charHandle + The handle of the GattCharacteristic to read from + + @returns ble_error_t + + @retval BLE_ERROR_NONE + Everything executed properly + + @section EXAMPLE + + @code + + @endcode +*/ +/**************************************************************************/ +ble_error_t BlueNRGGattServer::Read_Request_CB(uint16_t handle) +{ + //signed short refvalue; + uint16_t gapConnectionHandle = BlueNRGGap::getInstance().getConnectionHandle(); + + GattReadCallbackParams readParams; + readParams.handle = handle; + + //DEBUG("readParams.charHandle = %d\n\r", readParams.charHandle); + HCIDataReadEvent(&readParams); + + //EXIT: + if(gapConnectionHandle != 0){ + //DEBUG("Calling aci_gatt_allow_read\n\r"); + aci_gatt_allow_read(gapConnectionHandle); + } + + return BLE_ERROR_NONE; +} + +/**************************************************************************/ +/*! + @brief Returns the GattCharacteristic according to the handle provided + + @param[in] charHandle + The handle of the GattCharacteristic + + @returns ble_error_t + + @retval BLE_ERROR_NONE + Everything executed properly + + @section EXAMPLE + + @code + + @endcode +*/ +/**************************************************************************/ +GattCharacteristic* BlueNRGGattServer::getCharacteristicFromHandle(uint16_t attrHandle) +{ + GattCharacteristic *p_char = NULL; + int i; + uint16_t handle, handle_1; + + DEBUG("BlueNRGGattServer::getCharacteristicFromHandle()>>Attribute Handle received %d\n\r",attrHandle); + for(i=0; i<characteristicCount; i++) + { + handle = p_characteristics[i]->getValueAttribute().getHandle(); + DEBUG("handle(%d)=%d\n\r", i, handle); + if(i==characteristicCount-1)//Last Characteristic check + { + if(attrHandle>=handle) + { + p_char = p_characteristics[i]; + DEBUG("Found Characteristic Properties 0x%x (handle=%d)\n\r",p_char->getProperties(), handle); + break; + } + } + else { + handle_1 = p_characteristics[i+1]->getValueAttribute().getHandle(); + //Testing if attribute handle is between two Characteristic Handles + if(attrHandle>=handle && attrHandle<handle_1) + { + p_char = p_characteristics[i]; + DEBUG("Found Characteristic Properties 0x%x (handle=%d handle_1=%d)\n\r",p_char->getProperties(), handle, handle_1); + break; + } else continue; + } + } + + return p_char; +} + +void BlueNRGGattServer::HCIDataWrittenEvent(const GattWriteCallbackParams *params) { + this->handleDataWrittenEvent(params); +} + +void BlueNRGGattServer::HCIDataReadEvent(const GattReadCallbackParams *params) { + DEBUG("Called HCIDataReadEvent\n\r"); + this->handleDataReadEvent(params); +} + +void BlueNRGGattServer::HCIEvent(GattServerEvents::gattEvent_e type, uint16_t charHandle) { + this->handleEvent(type, charHandle); +} + +void BlueNRGGattServer::HCIDataSentEvent(unsigned count) { + this->handleDataSentEvent(count); +} + + +ble_error_t BlueNRGGattServer::initializeGATTDatabase(void) { + // <TODO> + return (ble_error_t)0; +}