BLE test
Fork of X_NUCLEO_IDB0XA1 by
Diff: source/BlueNRGGap.cpp
- Revision:
- 130:770ce14d3d15
- Child:
- 132:51056160fa4a
diff -r d5686dd11391 -r 770ce14d3d15 source/BlueNRGGap.cpp --- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/source/BlueNRGGap.cpp Tue Oct 06 14:25:08 2015 +0200 @@ -0,0 +1,999 @@ +/* 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 BlueNRGGap.cpp + * @author STMicroelectronics + * @brief Implementation of BLE_API Gap 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 BlueNRGGap + * @brief BlueNRG BLE_API GAP Adaptation + * @{ + */ + +#include "BlueNRGDevice.h" +#include "mbed.h" +#include "Payload.h" +#include "Utils.h" + +//Local Variables +//const char *local_name = NULL; +//uint8_t local_name_length = 0; +const uint8_t *scan_response_payload = NULL; +uint8_t scan_rsp_length = 0; + +uint32_t advtInterval = BLUENRG_GAP_ADV_INTERVAL_MAX; + +/* + * Utility to process GAP specific events (e.g., Advertising timeout) + */ +void BlueNRGGap::Process(void) +{ + if(AdvToFlag) { + stopAdvertising(); + } + +} + +/**************************************************************************/ +/*! + @brief Sets the advertising parameters and payload for the device. + Note: Some data types give error when their adv data is updated using aci_gap_update_adv_data() API + + @params[in] advData + The primary advertising data payload + @params[in] scanResponse + The optional Scan Response payload if the advertising + type is set to \ref GapAdvertisingParams::ADV_SCANNABLE_UNDIRECTED + in \ref GapAdveritinngParams + + @returns \ref ble_error_t + + @retval BLE_ERROR_NONE + Everything executed properly + + @retval BLE_ERROR_BUFFER_OVERFLOW + The proposed action would cause a buffer overflow. All + advertising payloads must be <= 31 bytes, for example. + + @retval BLE_ERROR_NOT_IMPLEMENTED + A feature was requested that is not yet supported in the + nRF51 firmware or hardware. + + @retval BLE_ERROR_PARAM_OUT_OF_RANGE + One of the proposed values is outside the valid range. + + @section EXAMPLE + + @code + + @endcode +*/ +/**************************************************************************/ +ble_error_t BlueNRGGap::setAdvertisingData(const GapAdvertisingData &advData, const GapAdvertisingData &scanResponse) +{ + DEBUG("BlueNRGGap::setAdvertisingData\n\r"); + /* Make sure we don't exceed the advertising payload length */ + if (advData.getPayloadLen() > GAP_ADVERTISING_DATA_MAX_PAYLOAD) { + return BLE_ERROR_BUFFER_OVERFLOW; + } + + /* Make sure we have a payload! */ + if (advData.getPayloadLen() <= 0) { + return BLE_ERROR_PARAM_OUT_OF_RANGE; + } else { + PayloadPtr loadPtr(advData.getPayload(), advData.getPayloadLen()); + for(uint8_t index=0; index<loadPtr.getPayloadUnitCount(); index++) { + loadPtr.getUnitAtIndex(index); + + DEBUG("adData[%d].length=%d\n\r", index,(uint8_t)(*loadPtr.getUnitAtIndex(index).getLenPtr())); + DEBUG("adData[%d].AdType=0x%x\n\r", index,(uint8_t)(*loadPtr.getUnitAtIndex(index).getAdTypePtr())); + + switch(*loadPtr.getUnitAtIndex(index).getAdTypePtr()) { + case GapAdvertisingData::FLAGS: /* ref *Flags */ + { + DEBUG("Advertising type: FLAGS\n\r"); + //Check if Flags are OK. BlueNRG only supports LE Mode. + uint8_t *flags = loadPtr.getUnitAtIndex(index).getDataPtr(); + if((*flags & GapAdvertisingData::BREDR_NOT_SUPPORTED) != GapAdvertisingData::BREDR_NOT_SUPPORTED) { + DEBUG("BlueNRG does not support BR/EDR Mode"); + return BLE_ERROR_PARAM_OUT_OF_RANGE; + } + + break; + } + case GapAdvertisingData::INCOMPLETE_LIST_16BIT_SERVICE_IDS: /**< Incomplete list of 16-bit Service IDs */ + case GapAdvertisingData::COMPLETE_LIST_16BIT_SERVICE_IDS: /**< Complete list of 16-bit Service IDs */ + { + DEBUG("Advertising type: INCOMPLETE_LIST_16BIT_SERVICE_IDS/COMPLETE_LIST_16BIT_SERVICE_IDS\n\r"); + + uint8_t buffSize = *loadPtr.getUnitAtIndex(index).getLenPtr()-1; + // The total lenght should include the Data Type Value + if(buffSize>UUID_BUFFER_SIZE-1) { + return BLE_ERROR_PARAM_OUT_OF_RANGE; + } + + servUuidlength = buffSize+1; // +1 to include the Data Type Value + servUuidData[0] = (uint8_t)(*loadPtr.getUnitAtIndex(index).getAdTypePtr()); //Data Type Value + + DEBUG("servUuidlength=%d servUuidData[0]=%d buffSize=%d\n\r", servUuidlength, servUuidData[0], buffSize); + // Save the Service UUID list just after the Data Type Value field + memcpy(servUuidData+1, loadPtr.getUnitAtIndex(index).getDataPtr(), buffSize); + + for(unsigned i=0; i<servUuidlength; i++) { + DEBUG("servUuidData[%d] = 0x%x\n\r", i, servUuidData[i]); + } + + for(unsigned i=0; i<buffSize; i++) { + DEBUG("loadPtr.getUnitAtIndex(index).getDataPtr()[%d] = 0x%x\n\r", i, loadPtr.getUnitAtIndex(index).getDataPtr()[i]); + } + + break; + } + case GapAdvertisingData::INCOMPLETE_LIST_32BIT_SERVICE_IDS: /**< Incomplete list of 32-bit Service IDs (not relevant for Bluetooth 4.0) */ + { + DEBUG("Advertising type: INCOMPLETE_LIST_32BIT_SERVICE_IDS\n\r"); + return BLE_ERROR_NOT_IMPLEMENTED; + } + case GapAdvertisingData::COMPLETE_LIST_32BIT_SERVICE_IDS: /**< Complete list of 32-bit Service IDs (not relevant for Bluetooth 4.0) */ + { + DEBUG("Advertising type: COMPLETE_LIST_32BIT_SERVICE_IDS\n\r"); + return BLE_ERROR_NOT_IMPLEMENTED; + } + case GapAdvertisingData::INCOMPLETE_LIST_128BIT_SERVICE_IDS: /**< Incomplete list of 128-bit Service IDs */ + { + DEBUG("Advertising type: INCOMPLETE_LIST_128BIT_SERVICE_IDS\n\r"); + return BLE_ERROR_NOT_IMPLEMENTED; + } + case GapAdvertisingData::COMPLETE_LIST_128BIT_SERVICE_IDS: /**< Complete list of 128-bit Service IDs */ + { + DEBUG("Advertising type: COMPLETE_LIST_128BIT_SERVICE_IDS\n\r"); + return BLE_ERROR_NOT_IMPLEMENTED; + } + case GapAdvertisingData::SHORTENED_LOCAL_NAME: /**< Shortened Local Name */ + { + break; + } + case GapAdvertisingData::COMPLETE_LOCAL_NAME: /**< Complete Local Name */ + { + DEBUG("Advertising type: COMPLETE_LOCAL_NAME\n\r"); + loadPtr.getUnitAtIndex(index).printDataAsString(); + local_name_length = *loadPtr.getUnitAtIndex(index).getLenPtr()-1; + local_name = (uint8_t*)loadPtr.getUnitAtIndex(index).getAdTypePtr(); + DEBUG("Advertising type: COMPLETE_LOCAL_NAME local_name=%s\n\r", local_name); + //COMPLETE_LOCAL_NAME is only advertising device name. Gatt Device Name is not the same.(Must be set right after GAP/GATT init?) + + DEBUG("device_name length=%d\n\r", local_name_length); + break; + } + case GapAdvertisingData::TX_POWER_LEVEL: /**< TX Power Level (in dBm) */ + { + DEBUG("Advertising type: TX_POWER_LEVEL\n\r"); + int8_t enHighPower = 0; + int8_t paLevel = 0; +#if NEED_CONSOLE_OUTPUT + int8_t dbm = *loadPtr.getUnitAtIndex(index).getDataPtr(); + int8_t dbmActuallySet = getHighPowerAndPALevelValue(dbm, enHighPower, paLevel); +#endif + DEBUG("dbm=%d, dbmActuallySet=%d\n\r", dbm, dbmActuallySet); + DEBUG("enHighPower=%d, paLevel=%d\n\r", enHighPower, paLevel); + aci_hal_set_tx_power_level(enHighPower, paLevel); + break; + } + case GapAdvertisingData::DEVICE_ID: /**< Device ID */ + { + break; + } + case GapAdvertisingData::SLAVE_CONNECTION_INTERVAL_RANGE: /**< Slave :Connection Interval Range */ + { + break; + } + case GapAdvertisingData::SERVICE_DATA: /**< Service Data */ + { + DEBUG("Advertising type: SERVICE_DATA\n\r"); + uint8_t buffSize = *loadPtr.getUnitAtIndex(index).getLenPtr()-1; + DEBUG("Advertising type: SERVICE_DATA (buffSize=%d)\n\r", buffSize); + // the total ADV DATA LEN should include two more bytes: the buffer size byte; and the Service Data Type Value byte + if(buffSize>ADV_DATA_MAX_SIZE-2) { + return BLE_ERROR_PARAM_OUT_OF_RANGE; + } + for(int i=0; i<buffSize+1; i++) { + DEBUG("Advertising type: SERVICE_DATA loadPtr.getUnitAtIndex(index).getDataPtr()[%d] = 0x%x\n\r", i, loadPtr.getUnitAtIndex(index).getDataPtr()[i]); + } + AdvLen = buffSize+2; // the total ADV DATA LEN should include two more bytes: the buffer size byte; and the Service Data Type Value byte + AdvData[0] = buffSize+1; // the fisrt byte is the data buffer size (type+data) + AdvData[1] = AD_TYPE_SERVICE_DATA; + memcpy(AdvData+2, loadPtr.getUnitAtIndex(index).getDataPtr(), buffSize); + break; + } + case GapAdvertisingData::APPEARANCE: + { + /* + Tested with GapAdvertisingData::GENERIC_PHONE. + for other appearances BLE Scanner android app is not behaving properly + */ + DEBUG("Advertising type: APPEARANCE\n\r"); + const char *deviceAppearance = NULL; + deviceAppearance = (const char*)loadPtr.getUnitAtIndex(index).getDataPtr(); // to be set later when startAdvertising() is called + +#if NEED_CONSOLE_OUTPUT + uint8_t Appearance[2] = {0, 0}; + uint16_t devP = (uint16_t)*deviceAppearance; + STORE_LE_16(Appearance, (uint16_t)devP); +#endif + + DEBUG("input: deviceAppearance= 0x%x 0x%x..., strlen(deviceAppearance)=%d\n\r", Appearance[1], Appearance[0], (uint8_t)*loadPtr.getUnitAtIndex(index).getLenPtr()-1); /**< \ref Appearance */ + + aci_gatt_update_char_value(g_gap_service_handle, g_appearance_char_handle, 0, 2, (uint8_t *)deviceAppearance);//not using array Appearance[2] + break; + } + case GapAdvertisingData::ADVERTISING_INTERVAL: /**< Advertising Interval */ + { + DEBUG("Advertising type: ADVERTISING_INTERVAL\n\r"); + advtInterval = (uint16_t)(*loadPtr.getUnitAtIndex(index).getDataPtr()); + DEBUG("advtInterval=%d\n\r", advtInterval); + break; + } + case GapAdvertisingData::MANUFACTURER_SPECIFIC_DATA: /**< Manufacturer Specific Data */ + { + break; + } + + } + } + //Set the SCAN_RSP Payload + scan_response_payload = scanResponse.getPayload(); + scan_rsp_length = scanResponse.getPayloadLen(); + } + return BLE_ERROR_NONE; +} + +/* + * Utility to set ADV timeout flag + */ +void BlueNRGGap::setAdvToFlag(void) { + AdvToFlag = true; +} + +/* + * ADV timeout callback + */ +static void advTimeoutCB(void) +{ + Gap::GapState_t state; + + state = BlueNRGGap::getInstance().getState(); + if (state.advertising == 1) { + + BlueNRGGap::getInstance().setAdvToFlag(); + + Timeout t = BlueNRGGap::getInstance().getAdvTimeout(); + t.detach(); /* disable the callback from the timeout */ + + } +} + + +/**************************************************************************/ +/*! + @brief Starts the BLE HW, initialising any services that were + added before this function was called. + + @param[in] params + Basic advertising details, including the advertising + delay, timeout and how the device should be advertised + + @note All services must be added before calling this function! + + @returns ble_error_t + + @retval BLE_ERROR_NONE + Everything executed properly + + @section EXAMPLE + + @code + + @endcode +*/ +/**************************************************************************/ + +ble_error_t BlueNRGGap::startAdvertising(const GapAdvertisingParams ¶ms) +{ + /* Make sure we support the advertising type */ + if (params.getAdvertisingType() == GapAdvertisingParams::ADV_CONNECTABLE_DIRECTED) { + /* ToDo: This requires a propery security implementation, etc. */ + return BLE_ERROR_NOT_IMPLEMENTED; + } + + /* Check interval range */ + if (params.getAdvertisingType() == GapAdvertisingParams::ADV_NON_CONNECTABLE_UNDIRECTED) { + /* Min delay is slightly longer for unconnectable devices */ + if ((params.getIntervalInADVUnits() < GapAdvertisingParams::GAP_ADV_PARAMS_INTERVAL_MIN_NONCON) || + (params.getIntervalInADVUnits() > GapAdvertisingParams::GAP_ADV_PARAMS_INTERVAL_MAX)) { + return BLE_ERROR_PARAM_OUT_OF_RANGE; + } + } else { + if ((params.getIntervalInADVUnits() < GapAdvertisingParams::GAP_ADV_PARAMS_INTERVAL_MIN) || + (params.getIntervalInADVUnits() > GapAdvertisingParams::GAP_ADV_PARAMS_INTERVAL_MAX)) { + return BLE_ERROR_PARAM_OUT_OF_RANGE; + } + } + + /* Check timeout is zero for Connectable Directed */ + if ((params.getAdvertisingType() == GapAdvertisingParams::ADV_CONNECTABLE_DIRECTED) && (params.getTimeout() != 0)) { + /* Timeout must be 0 with this type, although we'll never get here */ + /* since this isn't implemented yet anyway */ + return BLE_ERROR_PARAM_OUT_OF_RANGE; + } + + /* Check timeout for other advertising types */ + if ((params.getAdvertisingType() != GapAdvertisingParams::ADV_CONNECTABLE_DIRECTED) && + (params.getTimeout() > GapAdvertisingParams::GAP_ADV_PARAMS_TIMEOUT_MAX)) { + return BLE_ERROR_PARAM_OUT_OF_RANGE; + } + + //tBleStatus ret; + //const LongUUIDBytes_t HRM_SERVICE_UUID_128 = {0x18, 0x0D}; + /* set scan response data */ + hci_le_set_scan_resp_data(scan_rsp_length, scan_response_payload); /*int hci_le_set_scan_resp_data(uint8_t length, const uint8_t data[]);*/ + + /*aci_gap_set_discoverable(Advertising_Event_Type, Adv_min_intvl, Adv_Max_Intvl, Addr_Type, Adv_Filter_Policy, + Local_Name_Length, local_name, service_uuid_length, service_uuid_list, Slave_conn_intvl_min, Slave_conn_intvl_max);*/ + /*LINK_LAYER.H DESCRIBES THE ADVERTISING TYPES*/ + + char* name = NULL; + uint8_t nameLen = 0; + if(local_name!=NULL) { + name = (char*)local_name; + DEBUG("name=%s\n\r", name); + nameLen = local_name_length; + } else { + char str[] = "ST_BLE_DEV"; + name = new char[strlen(str)+1]; + name[0] = AD_TYPE_COMPLETE_LOCAL_NAME; + strcpy(name+1, str); + nameLen = strlen(name); + DEBUG("nameLen=%d\n\r", nameLen); + DEBUG("name=%s\n\r", name); + } + + advtInterval = params.getIntervalInADVUnits(); // set advtInterval in case it is not already set by user application + ret = aci_gap_set_discoverable(params.getAdvertisingType(), // Advertising_Event_Type + advtInterval, // Adv_Interval_Min + advtInterval, // Adv_Interval_Max + PUBLIC_ADDR, // Address_Type + NO_WHITE_LIST_USE, // Adv_Filter_Policy + nameLen, //local_name_length, // Local_Name_Length + (const char*)name, //local_name, // Local_Name + servUuidlength, //Service_Uuid_Length + servUuidData, //Service_Uuid_List + 0, // Slave_Conn_Interval_Min + 0); // Slave_Conn_Interval_Max + + + DEBUG("!!!setting discoverable (servUuidlength=0x%x)\n", servUuidlength); + if(BLE_STATUS_SUCCESS!=ret) { + DEBUG("error occurred while setting discoverable (ret=0x%x)\n", ret); + return BLE_ERROR_PARAM_OUT_OF_RANGE; // no other suitable error code is available + } + + // Before updating the ADV data, delete COMPLETE_LOCAL_NAME and TX_POWER_LEVEL fields (if present) + if(AdvLen>0) { + if(name!=NULL) { + DEBUG("!!!calling aci_gap_delete_ad_type AD_TYPE_COMPLETE_LOCAL_NAME!!!\n"); + ret = aci_gap_delete_ad_type(AD_TYPE_COMPLETE_LOCAL_NAME); + if (ret != BLE_STATUS_SUCCESS){ + DEBUG("aci_gap_delete_ad_type failed return=%d\n", ret); + return BLE_ERROR_PARAM_OUT_OF_RANGE; + } + } + + if(txPowerAdType) { + DEBUG("!!!calling aci_gap_delete_ad_type(AD_TYPE_TX_POWER_LEVEL)!!!\n", AdvLen); + ret = aci_gap_delete_ad_type(AD_TYPE_TX_POWER_LEVEL); + if (ret != BLE_STATUS_SUCCESS){ + DEBUG("aci_gap_delete_ad_type failed return=%d\n", ret); + return BLE_ERROR_PARAM_OUT_OF_RANGE; + } + } + + ret = aci_gap_update_adv_data(AdvLen, AdvData); + if(BLE_STATUS_SUCCESS!=ret) { + DEBUG("error occurred while adding adv data (ret=0x%x)\n", ret); + return BLE_ERROR_PARAM_OUT_OF_RANGE; // no other suitable error code is available + } + + } + + state.advertising = 1; + + AdvToFlag = false; + if(params.getTimeout() != 0) { + DEBUG("!!! attaching to!!!\n"); + advTimeout.attach(advTimeoutCB, params.getTimeout()); + } + + return BLE_ERROR_NONE; +} + +/**************************************************************************/ +/*! + @brief Stops the BLE HW and disconnects from any devices + + @returns ble_error_t + + @retval BLE_ERROR_NONE + Everything executed properly + + @section EXAMPLE + + @code + + @endcode +*/ +/**************************************************************************/ +ble_error_t BlueNRGGap::stopAdvertising(void) +{ + tBleStatus ret; + + if(state.advertising == 1) { + //Set non-discoverable to stop advertising + ret = aci_gap_set_non_discoverable(); + + if (ret != BLE_STATUS_SUCCESS){ + DEBUG("Error in stopping advertisement (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. + } + DEBUG("Advertisement stopped!!\n\r") ; + //Set GapState_t::advertising state + state.advertising = 0; + } + + return BLE_ERROR_NONE; +} + +/**************************************************************************/ +/*! + @brief Disconnects if we are connected to a central device + + @param[in] reason + Disconnection Reason + + @returns ble_error_t + + @retval BLE_ERROR_NONE + Everything executed properly + + @section EXAMPLE + + @code + + @endcode +*/ +/**************************************************************************/ +ble_error_t BlueNRGGap::disconnect(Gap::DisconnectionReason_t reason) +{ + tBleStatus ret; + //For Reason codes check BlueTooth HCI Spec + + if(m_connectionHandle != BLE_CONN_HANDLE_INVALID) { + ret = aci_gap_terminate(m_connectionHandle, 0x16);//0x16 Connection Terminated by Local Host. + + if (ret != BLE_STATUS_SUCCESS){ + DEBUG("Error in GAP termination!!\n\r") ; + return BLE_ERROR_PARAM_OUT_OF_RANGE ; //Not correct Error Value + //FIXME: Define Error values equivalent to BlueNRG Error Codes. + } + + //DEBUG("Disconnected from localhost!!\n\r") ; + m_connectionHandle = BLE_CONN_HANDLE_INVALID; + } + + return BLE_ERROR_NONE; +} + +/**************************************************************************/ +/*! + @brief Disconnects if we are connected to a central device + + @param[in] reason + Disconnection Reason + + @returns ble_error_t + + @retval BLE_ERROR_NONE + Everything executed properly + + @section EXAMPLE + + @code + + @endcode +*/ +/**************************************************************************/ +ble_error_t BlueNRGGap::disconnect(Handle_t connectionHandle, Gap::DisconnectionReason_t reason) +{ + tBleStatus ret; + //For Reason codes check BlueTooth HCI Spec + + if(connectionHandle != BLE_CONN_HANDLE_INVALID) { + ret = aci_gap_terminate(connectionHandle, 0x16);//0x16 Connection Terminated by Local Host. + + if (ret != BLE_STATUS_SUCCESS){ + DEBUG("Error in GAP termination!!\n\r") ; + return BLE_ERROR_PARAM_OUT_OF_RANGE ; //Not correct Error Value + //FIXME: Define Error values equivalent to BlueNRG Error Codes. + } + + //DEBUG("Disconnected from localhost!!\n\r") ; + m_connectionHandle = BLE_CONN_HANDLE_INVALID; + } + + return BLE_ERROR_NONE; +} + +/**************************************************************************/ +/*! + @brief Sets the 16-bit connection handle + + @param[in] con_handle + Connection Handle which is set in the Gap Instance + + @returns void +*/ +/**************************************************************************/ +void BlueNRGGap::setConnectionHandle(uint16_t con_handle) +{ + m_connectionHandle = con_handle; +} + +/**************************************************************************/ +/*! + @brief Gets the 16-bit connection handle + + @param[in] void + + @returns uint16_t + Connection Handle of the Gap Instance +*/ +/**************************************************************************/ +uint16_t BlueNRGGap::getConnectionHandle(void) +{ + return m_connectionHandle; +} + +/**************************************************************************/ +/*! + @brief Sets the BLE device address. SetAddress will reset the BLE + device and re-initialize BTLE. Will not start advertising. + + @param[in] type + Type of Address + + @param[in] address[6] + Value of the Address to be set + + @returns ble_error_t + + @section EXAMPLE + + @code + + @endcode +*/ +/**************************************************************************/ +ble_error_t BlueNRGGap::setAddress(addr_type_t type, const Address_t address) +{ + //tBleStatus ret; + + if (type > ADDR_TYPE_RANDOM_PRIVATE_NON_RESOLVABLE) { + return BLE_ERROR_PARAM_OUT_OF_RANGE; + } + + //copy address to bdAddr[6] + for(int i=0; i<BDADDR_SIZE; i++) { + bdaddr[i] = address[i]; + //DEBUG("i[%d]:0x%x\n\r",i,bdaddr[i]); + } + + if(!isSetAddress) isSetAddress = true; + + //Re-Init the BTLE Device with SetAddress as true + //if(BlueNRGDevice::getIsInitialized())//Re-init only initialization is already done + // ANDREA + //btle_init(isSetAddress, D11, D12, D3); + + //if (ret==BLE_STATUS_SUCCESS) + return BLE_ERROR_NONE; +} + +/**************************************************************************/ +/*! + @brief Returns boolean if the address of the device has been set + or not + + @returns bool + + @section EXAMPLE + + @code + + @endcode +*/ +/**************************************************************************/ +bool BlueNRGGap::getIsSetAddress() +{ + return isSetAddress; +} + +/**************************************************************************/ +/*! + @brief Returns the address of the device if set + + @returns Pointer to the address if Address is set else NULL + + @section EXAMPLE + + @code + + @endcode +*/ +/**************************************************************************/ +ble_error_t BlueNRGGap::getAddress(AddressType_t *typeP, Address_t address) +{ + *typeP = Gap::ADDR_TYPE_PUBLIC; + + if(isSetAddress) + { + for(int i=0; i<BDADDR_SIZE; i++) { + address[i] = bdaddr[i]; + //DEBUG("i[%d]:0x%x\n\r",i,bdaddr[i]); + } + } + + return BLE_ERROR_NONE; +} + +/**************************************************************************/ +/*! + @brief obtains preferred connection params + + @returns ble_error_t + + @section EXAMPLE + + @code + + @endcode +*/ +/**************************************************************************/ +ble_error_t BlueNRGGap::getPreferredConnectionParams(ConnectionParams_t *params) +{ + return BLE_ERROR_NONE; +} + + +/**************************************************************************/ +/*! + @brief sets preferred connection params + + @returns ble_error_t + + @section EXAMPLE + + @code + + @endcode +*/ +/**************************************************************************/ +ble_error_t BlueNRGGap::setPreferredConnectionParams(const ConnectionParams_t *params) +{ + return BLE_ERROR_NONE; +} + +/**************************************************************************/ +/*! + @brief updates preferred connection params + + @returns ble_error_t + + @section EXAMPLE + + @code + + @endcode +*/ +/**************************************************************************/ +ble_error_t BlueNRGGap::updateConnectionParams(Handle_t handle, const ConnectionParams_t *params) +{ + return BLE_ERROR_NONE; +} + +/**************************************************************************/ +/*! + @brief Sets the Device Name Characteristic + + @param[in] deviceName + pointer to device name to be set + + @returns ble_error_t + + @retval BLE_ERROR_NONE + Everything executed properly + + @section EXAMPLE + + @code + + @endcode +*/ +/**************************************************************************/ +ble_error_t BlueNRGGap::setDeviceName(const uint8_t *deviceName) +{ + int ret; + uint8_t nameLen = 0; + + DeviceName = (uint8_t *)deviceName; + //DEBUG("SetDeviceName=%s\n\r", DeviceName); + + nameLen = strlen((const char*)DeviceName); + //DEBUG("DeviceName Size=%d\n\r", nameLen); + + ret = aci_gatt_update_char_value(g_gap_service_handle, + g_device_name_char_handle, + 0, + nameLen, + (uint8_t *)DeviceName); + + if(ret){ + DEBUG("device set name failed\n\r"); + return BLE_ERROR_PARAM_OUT_OF_RANGE;//TODO:Wrong error code + } + + return BLE_ERROR_NONE; +} + +/**************************************************************************/ +/*! + @brief Gets the Device Name Characteristic + + @param[in] deviceName + pointer to device name + + @param[in] lengthP + pointer to device name length + + @returns ble_error_t + + @retval BLE_ERROR_NONE + Everything executed properly + + @section EXAMPLE + + @code + + @endcode +*/ +/**************************************************************************/ +ble_error_t BlueNRGGap::getDeviceName(uint8_t *deviceName, unsigned *lengthP) +{ + //int ret; + + if(DeviceName==NULL) + return BLE_ERROR_PARAM_OUT_OF_RANGE; + + strcpy((char*)deviceName, (const char*)DeviceName); + //DEBUG("GetDeviceName=%s\n\r", deviceName); + + *lengthP = strlen((const char*)DeviceName); + //DEBUG("DeviceName Size=%d\n\r", *lengthP); + + return BLE_ERROR_NONE; +} + +/**************************************************************************/ +/*! + @brief Sets the Device Appearance Characteristic + + @param[in] appearance + device appearance + + @returns ble_error_t + + @retval BLE_ERROR_NONE + Everything executed properly + + @section EXAMPLE + + @code + + @endcode +*/ +/**************************************************************************/ +ble_error_t BlueNRGGap::setAppearance(GapAdvertisingData::Appearance appearance) +{ + /* + Tested with GapAdvertisingData::GENERIC_PHONE. + for other appearances BLE Scanner android app is not behaving properly + */ + //char deviceAppearance[2]; + STORE_LE_16(deviceAppearance, appearance); + DEBUG("input: incoming = %d deviceAppearance= 0x%x 0x%x\n\r", appearance, deviceAppearance[1], deviceAppearance[0]); + + aci_gatt_update_char_value(g_gap_service_handle, g_appearance_char_handle, 0, 2, (uint8_t *)deviceAppearance); + + return BLE_ERROR_NONE; +} + +/**************************************************************************/ +/*! + @brief Gets the Device Appearance Characteristic + + @param[in] appearance + pointer to device appearance value + + @returns ble_error_t + + @retval BLE_ERROR_NONE + Everything executed properly + + @section EXAMPLE + + @code + + @endcode +*/ +/**************************************************************************/ +ble_error_t BlueNRGGap::getAppearance(GapAdvertisingData::Appearance *appearanceP) +{ + uint16_t devP; + if(!appearanceP) return BLE_ERROR_PARAM_OUT_OF_RANGE; + devP = ((uint16_t)(0x0000|deviceAppearance[0])) | (((uint16_t)(0x0000|deviceAppearance[1]))<<8); + strcpy((char*)appearanceP, (const char*)&devP); + + return BLE_ERROR_NONE; +} + +/**************************************************************************/ +/*! + @brief Gets the value of maximum advertising interval in ms + + @returns uint16_t + + @retval value of maximum advertising interval in ms + + @section EXAMPLE + + @code + + @endcode +*/ +/**************************************************************************/ +uint16_t BlueNRGGap::getMaxAdvertisingInterval(void) const { + return advtInterval; +} + + +/**************************************************************************/ +/*! + @brief Gets the value of minimum advertising interval in ms + + @returns uint16_t + + @retval value of minimum advertising interval in ms + + @section EXAMPLE + + @code + + @endcode +*/ +/**************************************************************************/ +uint16_t BlueNRGGap::getMinAdvertisingInterval(void) const { + return 0; // minimum Advertising interval is 0 +} + +/**************************************************************************/ +/*! + @brief Gets the value of minimum non connectable advertising interval in ms + + @returns uint16_t + + @retval value of minimum non connectable advertising interval in ms + + @section EXAMPLE + + @code + + @endcode +*/ +/**************************************************************************/ +uint16_t BlueNRGGap::getMinNonConnectableAdvertisingInterval(void) const { + return BLE_GAP_ADV_NONCON_INTERVAL_MIN; +} + +// ANDREA +ble_error_t BlueNRGGap::startRadioScan(const GapScanningParams &scanningParams) { + // Empty by now + return BLE_ERROR_NONE; +} + +ble_error_t BlueNRGGap::stopScan() { + // Empty by now + return BLE_ERROR_NONE; +} + +/**************************************************************************/ +/*! + @brief set Tx power level + @param[in] txPower Transmission Power level + @returns ble_error_t +*/ +/**************************************************************************/ +ble_error_t BlueNRGGap::setTxPower(int8_t txPower) +{ + tBleStatus ret; + + int8_t enHighPower = 0; + int8_t paLevel = 0; +#if NEED_CONSOLE_OUTPUT + int8_t dbmActuallySet = getHighPowerAndPALevelValue(txPower, enHighPower, paLevel); +#endif + + DEBUG("txPower=%d, dbmActuallySet=%d\n\r", txPower, dbmActuallySet); + DEBUG("enHighPower=%d, paLevel=%d\n\r", enHighPower, paLevel); + ret = aci_hal_set_tx_power_level(enHighPower, paLevel); + if(ret!=BLE_STATUS_SUCCESS) { + return BLE_ERROR_UNSPECIFIED; + } + + txPowerAdType = true; + return BLE_ERROR_NONE; +} + +/**************************************************************************/ +/*! + @brief get permitted Tx power values + @param[in] values pointer to pointer to permitted power values + @param[in] num number of values +*/ +/**************************************************************************/ +void BlueNRGGap::getPermittedTxPowerValues(const int8_t **valueArrayPP, size_t *countP) { + static const int8_t permittedTxValues[] = { + -18, -14, -11, -8, -4, -1, 1, 5, -15, -11, -8, -5, -2, 1, 4, 8 + }; + + *valueArrayPP = permittedTxValues; + *countP = sizeof(permittedTxValues) / sizeof(int8_t); +}