BLE lib
Fork of Nucleo_BLE_BlueNRG by
BlueNRGGap.cpp
- Committer:
- sjallouli
- Date:
- 2014-12-19
- Revision:
- 0:a948f5f3904c
File content as of revision 0:a948f5f3904c:
/* 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. */ #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; uint8_t servUuidlength = 0; uint8_t* servUuidData = NULL; uint32_t advtInterval = 0; /**************************************************************************/ /*! @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 @param[in] params Basic advertising details, including the advertising delay, timeout and how the device should be advertised @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++) { PayloadUnit unit = 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 */ { //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 */ { break; } case GapAdvertisingData::COMPLETE_LIST_16BIT_SERVICE_IDS: /**< Complete list of 16-bit Service IDs */ { DEBUG("Advertising type: COMPLETE_LIST_16BIT_SERVICE_IDS\n\r"); DEBUG("Advertising type: COMPLETE_LIST_16BIT_SERVICE_IDS\n"); #if 0 int err = aci_gap_update_adv_data(*loadPtr.getUnitAtIndex(index).getLenPtr(), loadPtr.getUnitAtIndex(index).getAdTypePtr()); if(BLE_STATUS_SUCCESS!=err) { DEBUG("error occurred while adding adv data\n"); return BLE_ERROR_PARAM_OUT_OF_RANGE; // no other suitable error code is available } #endif break; } case GapAdvertisingData::INCOMPLETE_LIST_32BIT_SERVICE_IDS: /**< Incomplete list of 32-bit Service IDs (not relevant for Bluetooth 4.0) */ { break; } case GapAdvertisingData::COMPLETE_LIST_32BIT_SERVICE_IDS: /**< Complete list of 32-bit Service IDs (not relevant for Bluetooth 4.0) */ { break; } case GapAdvertisingData::INCOMPLETE_LIST_128BIT_SERVICE_IDS: /**< Incomplete list of 128-bit Service IDs */ { break; } case GapAdvertisingData::COMPLETE_LIST_128BIT_SERVICE_IDS: /**< Complete list of 128-bit Service IDs */ { break; } 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 = (const char*)loadPtr.getUnitAtIndex(index).getAdTypePtr(); //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 dbm = *loadPtr.getUnitAtIndex(index).getDataPtr(); int8_t enHighPower = 0; int8_t paLevel = 0; int8_t dbmActuallySet = getHighPowerAndPALevelValue(dbm, enHighPower, paLevel); 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 */ { 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 uint8_t Appearance[2]; uint16_t devP = (uint16_t)*deviceAppearance; STORE_LE_16(Appearance, (uint16_t)devP); 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, (tHalUint8 *)deviceAppearance);//not using array Appearance[2] break; } case GapAdvertisingData::ADVERTISING_INTERVAL: /**< Advertising Interval */ { 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; } /**************************************************************************/ /*! @brief Starts the BLE HW, initialising any services that were added before this function was called. @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.getInterval() < GAP_ADV_PARAMS_INTERVAL_MIN_NONCON) || (params.getInterval() > GAP_ADV_PARAMS_INTERVAL_MAX)) { return BLE_ERROR_PARAM_OUT_OF_RANGE; } } else { if ((params.getInterval() < GAP_ADV_PARAMS_INTERVAL_MIN) || (params.getInterval() > 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() > 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.getInterval(); // set advtInterval in case it is not already set by user application ret = aci_gap_set_discoverable(params.getAdvertisingType(), // Advertising_Event_Type 0, // 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 state.advertising = 1; 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!!\n\r") ; 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 @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 Sets the 16-bit connection handle */ /**************************************************************************/ void BlueNRGGap::setConnectionHandle(uint16_t con_handle) { m_connectionHandle = con_handle; } /**************************************************************************/ /*! @brief Gets the 16-bit connection handle */ /**************************************************************************/ 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. @returns ble_error_t @section EXAMPLE @code @endcode */ /**************************************************************************/ ble_error_t BlueNRGGap::setAddress(addr_type_t type, const uint8_t address[6]) { 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 btle_init(isSetAddress); //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 ble_error_t @section EXAMPLE @code @endcode */ /**************************************************************************/ tHalUint8* BlueNRGGap::getAddress() { if(isSetAddress) return bdaddr; else return NULL; } /**************************************************************************/ /*! @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 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, (tHalUint8 *)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 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 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(uint16_t 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, (tHalUint8 *)deviceAppearance); return BLE_ERROR_NONE; } /**************************************************************************/ /*! @brief gets device appearance @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(uint16_t *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; }