X_NUCLEO_IDB0XA1 - BLE_API wrapper library for STMicroelectronics' B…

ST » Code » X_NUCLEO_IDB0XA1

BLE_API wrapper library for STMicroelectronics' BlueNRG Bluetooth Low Energy expansion board shield (Component)

Dependents: Nucleo_Zumo_BLE_IDB04A1 contest_IOT5 contest_IOT6 contest_IOT_10 ... more

Fork of X_NUCLEO_IDB0XA1 by ST Expansion SW Team

Arduino Connector Compatibility Warning

X-NUCLEO-IDB04A1 and X-NUCLEO-IDB05A1 are Arduino compatible with an exception: instead of using pin D13 for the SPI clock, they use pin D3. The default configuration for this library is having the SPI clock on pin D3.

To be fully Arduino compatible, X-NUCLEO-IDB04A1 and X-NUCLEO-IDB05A1 need a small HW patch.

For X-NUCLEO-IDB04A1 this patch consists in removing zero resistor R10 and instead soldering zero resistor R11. For X-NUCLEO-IDB05A1 this patch consists in removing zero resistor R4 and instead soldering zero resistor R6.

In case you patch your board, then you also have to configure this library to use pin D13 to drive the SPI clock (see macro IDB0XA1_D13_PATCH in file x_nucleo_idb0xa1_targets.h).

If you use pin D13 for the SPI clock, please be aware that on STM32 Nucleo boards you may not drive the LED, otherwise you will get a conflict: the LED on STM32 Nucleo boards is connected to pin D13.

Referring to the current list of tested platforms (see X-NUCLEO-IDB04A1 and X-NUCLEO-IDB05A1 pages), the patch is required by ST-Nucleo-F103RB; ST-Nucleo-F302R8; ST-Nucleo-F411RE; and ST-Nucleo-F446RE.

source/BlueNRGGap.cpp@242:058b2e731adc, 2016-06-20 (annotated)

Committer:: Andrea Palmieri
Date:: Mon Jun 20 14:59:06 2016 +0200
Revision:: 242:058b2e731adc
Parent:: 215:e8fa3129410a
Parent:: 240:f487d8c86ce4
Child:: 252:0c2cb16a7166

Merge branch 'master' into mbed_classic



Signed-off-by: Andrea Palmieri <andrea.palmieri@st.com>



Conflicts:

	source/BlueNRGGap.cpp

	source/BlueNRGGattClient.cpp

	x-nucleo-idb0xa1/BlueNRGGattClient.h

Who changed what in which revision?

User	Revision	Line number	New contents of line
Wolfgang Betz	130:770ce14d3d15	1	/* mbed Microcontroller Library
Wolfgang Betz	130:770ce14d3d15	2	* Copyright (c) 2006-2013 ARM Limited
Wolfgang Betz	130:770ce14d3d15	3	*
Wolfgang Betz	130:770ce14d3d15	4	* Licensed under the Apache License, Version 2.0 (the "License");
Wolfgang Betz	130:770ce14d3d15	5	* you may not use this file except in compliance with the License.
Wolfgang Betz	130:770ce14d3d15	6	* You may obtain a copy of the License at
Wolfgang Betz	130:770ce14d3d15	7	*
Wolfgang Betz	130:770ce14d3d15	8	* http://www.apache.org/licenses/LICENSE-2.0
Wolfgang Betz	130:770ce14d3d15	9	*
Wolfgang Betz	130:770ce14d3d15	10	* Unless required by applicable law or agreed to in writing, software
Wolfgang Betz	130:770ce14d3d15	11	* distributed under the License is distributed on an "AS IS" BASIS,
Wolfgang Betz	130:770ce14d3d15	12	* WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
Wolfgang Betz	130:770ce14d3d15	13	* See the License for the specific language governing permissions and
Wolfgang Betz	130:770ce14d3d15	14	* limitations under the License.
Wolfgang Betz	130:770ce14d3d15	15	*/
Wolfgang Betz	130:770ce14d3d15	16
Wolfgang Betz	130:770ce14d3d15	17
Wolfgang Betz	130:770ce14d3d15	18	/**
Wolfgang Betz	130:770ce14d3d15	19	******************************************************************************
Wolfgang Betz	130:770ce14d3d15	20	* @file BlueNRGGap.cpp
Wolfgang Betz	130:770ce14d3d15	21	* @author STMicroelectronics
Wolfgang Betz	130:770ce14d3d15	22	* @brief Implementation of BLE_API Gap Class
Wolfgang Betz	130:770ce14d3d15	23	******************************************************************************
Wolfgang Betz	130:770ce14d3d15	24	* @copy
Wolfgang Betz	130:770ce14d3d15	25	*
Wolfgang Betz	130:770ce14d3d15	26	* THE PRESENT FIRMWARE WHICH IS FOR GUIDANCE ONLY AIMS AT PROVIDING CUSTOMERS
Wolfgang Betz	130:770ce14d3d15	27	* WITH CODING INFORMATION REGARDING THEIR PRODUCTS IN ORDER FOR THEM TO SAVE
Wolfgang Betz	130:770ce14d3d15	28	* TIME. AS A RESULT, STMICROELECTRONICS SHALL NOT BE HELD LIABLE FOR ANY
Wolfgang Betz	130:770ce14d3d15	29	* DIRECT, INDIRECT OR CONSEQUENTIAL DAMAGES WITH RESPECT TO ANY CLAIMS ARISING
Wolfgang Betz	130:770ce14d3d15	30	* FROM THE CONTENT OF SUCH FIRMWARE AND/OR THE USE MADE BY CUSTOMERS OF THE
Wolfgang Betz	130:770ce14d3d15	31	* CODING INFORMATION CONTAINED HEREIN IN CONNECTION WITH THEIR PRODUCTS.
Wolfgang Betz	130:770ce14d3d15	32	*
Wolfgang Betz	130:770ce14d3d15	33	* <h2><center>© COPYRIGHT 2013 STMicroelectronics</center></h2>
Andrea Palmieri	229:9981f62cdb1a	34	*/
Wolfgang Betz	130:770ce14d3d15	35
Wolfgang Betz	130:770ce14d3d15	36	/** @defgroup BlueNRGGap
Wolfgang Betz	130:770ce14d3d15	37	* @brief BlueNRG BLE_API GAP Adaptation
Wolfgang Betz	130:770ce14d3d15	38	* @{
Wolfgang Betz	130:770ce14d3d15	39	*/
Wolfgang Betz	130:770ce14d3d15	40
Wolfgang Betz	130:770ce14d3d15	41	#include "BlueNRGDevice.h"
Andrea Palmieri	177:65d9b1b75fca	42	#include "mbed.h"
Wolfgang Betz	130:770ce14d3d15	43	#include "Payload.h"
Wolfgang Betz	130:770ce14d3d15	44	#include "Utils.h"
Wolfgang Betz	132:51056160fa4a	45	#include "debug.h"
Wolfgang Betz	130:770ce14d3d15	46
Wolfgang Betz	130:770ce14d3d15	47	//Local Variables
Wolfgang Betz	130:770ce14d3d15	48	//const char *local_name = NULL;
Wolfgang Betz	130:770ce14d3d15	49	//uint8_t local_name_length = 0;
Wolfgang Betz	130:770ce14d3d15	50
Wolfgang Betz	130:770ce14d3d15	51	/*
Wolfgang Betz	130:770ce14d3d15	52	* Utility to process GAP specific events (e.g., Advertising timeout)
Wolfgang Betz	130:770ce14d3d15	53	*/
Wolfgang Betz	130:770ce14d3d15	54	void BlueNRGGap::Process(void)
Wolfgang Betz	130:770ce14d3d15	55	{
Wolfgang Betz	130:770ce14d3d15	56	if(AdvToFlag) {
Wolfgang Betz	130:770ce14d3d15	57	stopAdvertising();
Wolfgang Betz	130:770ce14d3d15	58	}
Wolfgang Betz	130:770ce14d3d15	59
Wolfgang Betz	130:770ce14d3d15	60	}
Wolfgang Betz	130:770ce14d3d15	61
Wolfgang Betz	130:770ce14d3d15	62	/**************************************************************************/
Wolfgang Betz	130:770ce14d3d15	63	/*!
Wolfgang Betz	130:770ce14d3d15	64	@brief Sets the advertising parameters and payload for the device.
Wolfgang Betz	130:770ce14d3d15	65	Note: Some data types give error when their adv data is updated using aci_gap_update_adv_data() API
Wolfgang Betz	130:770ce14d3d15	66
Wolfgang Betz	130:770ce14d3d15	67	@params[in] advData
Wolfgang Betz	130:770ce14d3d15	68	The primary advertising data payload
Wolfgang Betz	130:770ce14d3d15	69	@params[in] scanResponse
Wolfgang Betz	130:770ce14d3d15	70	The optional Scan Response payload if the advertising
Wolfgang Betz	130:770ce14d3d15	71	type is set to \ref GapAdvertisingParams::ADV_SCANNABLE_UNDIRECTED
Wolfgang Betz	130:770ce14d3d15	72	in \ref GapAdveritinngParams
Wolfgang Betz	130:770ce14d3d15	73
Wolfgang Betz	130:770ce14d3d15	74	@returns \ref ble_error_t
Wolfgang Betz	130:770ce14d3d15	75
Wolfgang Betz	130:770ce14d3d15	76	@retval BLE_ERROR_NONE
Wolfgang Betz	130:770ce14d3d15	77	Everything executed properly
Wolfgang Betz	130:770ce14d3d15	78
Wolfgang Betz	130:770ce14d3d15	79	@retval BLE_ERROR_BUFFER_OVERFLOW
Wolfgang Betz	130:770ce14d3d15	80	The proposed action would cause a buffer overflow. All
Wolfgang Betz	130:770ce14d3d15	81	advertising payloads must be <= 31 bytes, for example.
Wolfgang Betz	130:770ce14d3d15	82
Wolfgang Betz	130:770ce14d3d15	83	@retval BLE_ERROR_NOT_IMPLEMENTED
Wolfgang Betz	130:770ce14d3d15	84	A feature was requested that is not yet supported in the
Wolfgang Betz	130:770ce14d3d15	85	nRF51 firmware or hardware.
Wolfgang Betz	130:770ce14d3d15	86
Wolfgang Betz	130:770ce14d3d15	87	@retval BLE_ERROR_PARAM_OUT_OF_RANGE
Wolfgang Betz	130:770ce14d3d15	88	One of the proposed values is outside the valid range.
Wolfgang Betz	130:770ce14d3d15	89
Wolfgang Betz	130:770ce14d3d15	90	@section EXAMPLE
Wolfgang Betz	130:770ce14d3d15	91
Wolfgang Betz	130:770ce14d3d15	92	@code
Wolfgang Betz	130:770ce14d3d15	93
Wolfgang Betz	130:770ce14d3d15	94	@endcode
Wolfgang Betz	130:770ce14d3d15	95	*/
Wolfgang Betz	130:770ce14d3d15	96	/**************************************************************************/
Wolfgang Betz	130:770ce14d3d15	97	ble_error_t BlueNRGGap::setAdvertisingData(const GapAdvertisingData &advData, const GapAdvertisingData &scanResponse)
Wolfgang Betz	130:770ce14d3d15	98	{
Wolfgang Betz	132:51056160fa4a	99	PRINTF("BlueNRGGap::setAdvertisingData\n\r");
Wolfgang Betz	130:770ce14d3d15	100	/* Make sure we don't exceed the advertising payload length */
Wolfgang Betz	130:770ce14d3d15	101	if (advData.getPayloadLen() > GAP_ADVERTISING_DATA_MAX_PAYLOAD) {
Andrea Palmieri	237:64c2ddbd9329	102	PRINTF("Exceeded the advertising payload length\n\r");
Wolfgang Betz	130:770ce14d3d15	103	return BLE_ERROR_BUFFER_OVERFLOW;
Wolfgang Betz	130:770ce14d3d15	104	}
Wolfgang Betz	130:770ce14d3d15	105
Wolfgang Betz	130:770ce14d3d15	106	/* Make sure we have a payload! */
Andrea Palmieri	229:9981f62cdb1a	107	if (advData.getPayloadLen() == 0) {
Andrea Palmieri	229:9981f62cdb1a	108	PRINTF("advData.getPayloadLen() == 0\n\r");
Andrea Palmieri	229:9981f62cdb1a	109	//return BLE_ERROR_PARAM_OUT_OF_RANGE;
Andrea Palmieri	229:9981f62cdb1a	110	local_name_length = 0;
Andrea Palmieri	229:9981f62cdb1a	111	servUuidlength = 0;
Andrea Palmieri	229:9981f62cdb1a	112	AdvLen = 0;
Andrea Palmieri	236:2a73f3a97452	113	} else {
Andrea Palmieri	236:2a73f3a97452	114	PayloadPtr loadPtr(advData.getPayload(), advData.getPayloadLen());
Andrea Palmieri	236:2a73f3a97452	115
Wolfgang Betz	130:770ce14d3d15	116	for(uint8_t index=0; index<loadPtr.getPayloadUnitCount(); index++) {
Wolfgang Betz	130:770ce14d3d15	117	loadPtr.getUnitAtIndex(index);
Wolfgang Betz	130:770ce14d3d15	118
Wolfgang Betz	132:51056160fa4a	119	PRINTF("adData[%d].length=%d\n\r", index,(uint8_t)(*loadPtr.getUnitAtIndex(index).getLenPtr()));
Wolfgang Betz	132:51056160fa4a	120	PRINTF("adData[%d].AdType=0x%x\n\r", index,(uint8_t)(*loadPtr.getUnitAtIndex(index).getAdTypePtr()));
Wolfgang Betz	130:770ce14d3d15	121
Wolfgang Betz	130:770ce14d3d15	122	switch(*loadPtr.getUnitAtIndex(index).getAdTypePtr()) {
Wolfgang Betz	130:770ce14d3d15	123	case GapAdvertisingData::FLAGS: /* ref Flags /
Wolfgang Betz	130:770ce14d3d15	124	{
Wolfgang Betz	132:51056160fa4a	125	PRINTF("Advertising type: FLAGS\n\r");
Wolfgang Betz	130:770ce14d3d15	126	//Check if Flags are OK. BlueNRG only supports LE Mode.
Wolfgang Betz	130:770ce14d3d15	127	uint8_t *flags = loadPtr.getUnitAtIndex(index).getDataPtr();
Wolfgang Betz	130:770ce14d3d15	128	if((*flags & GapAdvertisingData::BREDR_NOT_SUPPORTED) != GapAdvertisingData::BREDR_NOT_SUPPORTED) {
Wolfgang Betz	132:51056160fa4a	129	PRINTF("BlueNRG does not support BR/EDR Mode");
Wolfgang Betz	130:770ce14d3d15	130	return BLE_ERROR_PARAM_OUT_OF_RANGE;
Wolfgang Betz	130:770ce14d3d15	131	}
Wolfgang Betz	130:770ce14d3d15	132
Wolfgang Betz	130:770ce14d3d15	133	break;
Wolfgang Betz	130:770ce14d3d15	134	}
Wolfgang Betz	130:770ce14d3d15	135	case GapAdvertisingData::INCOMPLETE_LIST_16BIT_SERVICE_IDS: /*< Incomplete list of 16-bit Service IDs /
Wolfgang Betz	130:770ce14d3d15	136	case GapAdvertisingData::COMPLETE_LIST_16BIT_SERVICE_IDS: /*< Complete list of 16-bit Service IDs /
Andrea Palmieri	189:30fa96fa8ec4	137	case GapAdvertisingData::INCOMPLETE_LIST_128BIT_SERVICE_IDS: /*< Incomplete list of 128-bit Service IDs /
Andrea Palmieri	189:30fa96fa8ec4	138	case GapAdvertisingData::COMPLETE_LIST_128BIT_SERVICE_IDS: /*< Complete list of 128-bit Service IDs /
Wolfgang Betz	130:770ce14d3d15	139	{
Andrea Palmieri	189:30fa96fa8ec4	140	PRINTF("Advertising type: INCOMPLETE_LIST SERVICE_IDS/COMPLETE_LIST SERVICE_IDS\n\r");
Wolfgang Betz	130:770ce14d3d15	141
Wolfgang Betz	130:770ce14d3d15	142	uint8_t buffSize = *loadPtr.getUnitAtIndex(index).getLenPtr()-1;
Wolfgang Betz	130:770ce14d3d15	143	// The total lenght should include the Data Type Value
Wolfgang Betz	130:770ce14d3d15	144	if(buffSize>UUID_BUFFER_SIZE-1) {
Andrea Palmieri	189:30fa96fa8ec4	145	return BLE_ERROR_INVALID_PARAM;
Wolfgang Betz	130:770ce14d3d15	146	}
Wolfgang Betz	130:770ce14d3d15	147
Wolfgang Betz	130:770ce14d3d15	148	servUuidlength = buffSize+1; // +1 to include the Data Type Value
Wolfgang Betz	130:770ce14d3d15	149	servUuidData[0] = (uint8_t)(*loadPtr.getUnitAtIndex(index).getAdTypePtr()); //Data Type Value
Wolfgang Betz	130:770ce14d3d15	150
Wolfgang Betz	132:51056160fa4a	151	PRINTF("servUuidlength=%d servUuidData[0]=%d buffSize=%d\n\r", servUuidlength, servUuidData[0], buffSize);
Wolfgang Betz	130:770ce14d3d15	152	// Save the Service UUID list just after the Data Type Value field
Wolfgang Betz	130:770ce14d3d15	153	memcpy(servUuidData+1, loadPtr.getUnitAtIndex(index).getDataPtr(), buffSize);
Andrea Palmieri	189:30fa96fa8ec4	154	#ifdef DEBUG
Wolfgang Betz	130:770ce14d3d15	155	for(unsigned i=0; i<servUuidlength; i++) {
Wolfgang Betz	132:51056160fa4a	156	PRINTF("servUuidData[%d] = 0x%x\n\r", i, servUuidData[i]);
Wolfgang Betz	130:770ce14d3d15	157	}
Wolfgang Betz	130:770ce14d3d15	158
Wolfgang Betz	130:770ce14d3d15	159	for(unsigned i=0; i<buffSize; i++) {
Andrea Palmieri	236:2a73f3a97452	160	PRINTF("loadPtr.getUnitAtIndex(index).getDataPtr()[%d] = 0x%x\n\r",
Andrea Palmieri	236:2a73f3a97452	161	i, loadPtr.getUnitAtIndex(index).getDataPtr()[i]);
Wolfgang Betz	130:770ce14d3d15	162	}
Andrea Palmieri	189:30fa96fa8ec4	163	#endif /* DEBUG */
Wolfgang Betz	130:770ce14d3d15	164	break;
Wolfgang Betz	130:770ce14d3d15	165	}
Wolfgang Betz	130:770ce14d3d15	166	case GapAdvertisingData::INCOMPLETE_LIST_32BIT_SERVICE_IDS: /*< Incomplete list of 32-bit Service IDs (not relevant for Bluetooth 4.0) /
Wolfgang Betz	130:770ce14d3d15	167	{
Wolfgang Betz	132:51056160fa4a	168	PRINTF("Advertising type: INCOMPLETE_LIST_32BIT_SERVICE_IDS\n\r");
Wolfgang Betz	130:770ce14d3d15	169	return BLE_ERROR_NOT_IMPLEMENTED;
Wolfgang Betz	130:770ce14d3d15	170	}
Wolfgang Betz	130:770ce14d3d15	171	case GapAdvertisingData::COMPLETE_LIST_32BIT_SERVICE_IDS: /*< Complete list of 32-bit Service IDs (not relevant for Bluetooth 4.0) /
Wolfgang Betz	130:770ce14d3d15	172	{
Wolfgang Betz	132:51056160fa4a	173	PRINTF("Advertising type: COMPLETE_LIST_32BIT_SERVICE_IDS\n\r");
Wolfgang Betz	130:770ce14d3d15	174	return BLE_ERROR_NOT_IMPLEMENTED;
Wolfgang Betz	130:770ce14d3d15	175	}
Wolfgang Betz	130:770ce14d3d15	176	case GapAdvertisingData::SHORTENED_LOCAL_NAME: /*< Shortened Local Name /
Wolfgang Betz	130:770ce14d3d15	177	{
Wolfgang Betz	130:770ce14d3d15	178	break;
Wolfgang Betz	130:770ce14d3d15	179	}
Wolfgang Betz	130:770ce14d3d15	180	case GapAdvertisingData::COMPLETE_LOCAL_NAME: /*< Complete Local Name /
Wolfgang Betz	130:770ce14d3d15	181	{
Wolfgang Betz	132:51056160fa4a	182	PRINTF("Advertising type: COMPLETE_LOCAL_NAME\n\r");
Andrea Palmieri	222:37a7e289ee3d	183	loadPtr.getUnitAtIndex(index).printDataAsString();
Andrea Palmieri	222:37a7e289ee3d	184	local_name_length = *loadPtr.getUnitAtIndex(index).getLenPtr()-1;
Andrea Palmieri	229:9981f62cdb1a	185	// The total length should include the Data Type Value
Andrea Palmieri	229:9981f62cdb1a	186	if(local_name_length>ADV_DATA_MAX_SIZE-1) {
Andrea Palmieri	222:37a7e289ee3d	187	return BLE_ERROR_INVALID_PARAM;
Andrea Palmieri	222:37a7e289ee3d	188	}
Andrea Palmieri	222:37a7e289ee3d	189	local_name[0] = (uint8_t)(*loadPtr.getUnitAtIndex(index).getAdTypePtr()); //Data Type Value
Andrea Palmieri	222:37a7e289ee3d	190	memcpy(local_name+1, (uint8_t*)loadPtr.getUnitAtIndex(index).getDataPtr(), local_name_length-1);
Andrea Palmieri	222:37a7e289ee3d	191	PRINTF("Advertising type: COMPLETE_LOCAL_NAME local_name=%s local_name_length=%d\n\r", local_name, local_name_length);
Andrea Palmieri	222:37a7e289ee3d	192
Wolfgang Betz	130:770ce14d3d15	193	break;
Wolfgang Betz	130:770ce14d3d15	194	}
Wolfgang Betz	130:770ce14d3d15	195	case GapAdvertisingData::TX_POWER_LEVEL: /*< TX Power Level (in dBm) /
Wolfgang Betz	130:770ce14d3d15	196	{
Wolfgang Betz	132:51056160fa4a	197	PRINTF("Advertising type: TX_POWER_LEVEL\n\r");
Wolfgang Betz	130:770ce14d3d15	198	int8_t enHighPower = 0;
Wolfgang Betz	130:770ce14d3d15	199	int8_t paLevel = 0;
Wolfgang Betz	132:51056160fa4a	200	#ifdef DEBUG
Wolfgang Betz	130:770ce14d3d15	201	int8_t dbm = *loadPtr.getUnitAtIndex(index).getDataPtr();
Wolfgang Betz	130:770ce14d3d15	202	int8_t dbmActuallySet = getHighPowerAndPALevelValue(dbm, enHighPower, paLevel);
Wolfgang Betz	130:770ce14d3d15	203	#endif
Wolfgang Betz	132:51056160fa4a	204	PRINTF("dbm=%d, dbmActuallySet=%d\n\r", dbm, dbmActuallySet);
Wolfgang Betz	132:51056160fa4a	205	PRINTF("enHighPower=%d, paLevel=%d\n\r", enHighPower, paLevel);
Wolfgang Betz	130:770ce14d3d15	206	aci_hal_set_tx_power_level(enHighPower, paLevel);
Wolfgang Betz	130:770ce14d3d15	207	break;
Wolfgang Betz	130:770ce14d3d15	208	}
Wolfgang Betz	130:770ce14d3d15	209	case GapAdvertisingData::DEVICE_ID: /*< Device ID /
Wolfgang Betz	130:770ce14d3d15	210	{
Wolfgang Betz	130:770ce14d3d15	211	break;
Wolfgang Betz	130:770ce14d3d15	212	}
Wolfgang Betz	130:770ce14d3d15	213	case GapAdvertisingData::SLAVE_CONNECTION_INTERVAL_RANGE: /*< Slave :Connection Interval Range /
Wolfgang Betz	130:770ce14d3d15	214	{
Wolfgang Betz	130:770ce14d3d15	215	break;
Wolfgang Betz	130:770ce14d3d15	216	}
Wolfgang Betz	130:770ce14d3d15	217	case GapAdvertisingData::SERVICE_DATA: /*< Service Data /
Wolfgang Betz	130:770ce14d3d15	218	{
Wolfgang Betz	132:51056160fa4a	219	PRINTF("Advertising type: SERVICE_DATA\n\r");
Wolfgang Betz	130:770ce14d3d15	220	uint8_t buffSize = *loadPtr.getUnitAtIndex(index).getLenPtr()-1;
Wolfgang Betz	132:51056160fa4a	221	PRINTF("Advertising type: SERVICE_DATA (buffSize=%d)\n\r", buffSize);
Wolfgang Betz	130:770ce14d3d15	222	// the total ADV DATA LEN should include two more bytes: the buffer size byte; and the Service Data Type Value byte
Wolfgang Betz	130:770ce14d3d15	223	if(buffSize>ADV_DATA_MAX_SIZE-2) {
Wolfgang Betz	130:770ce14d3d15	224	return BLE_ERROR_PARAM_OUT_OF_RANGE;
Wolfgang Betz	130:770ce14d3d15	225	}
Andrea Palmieri	229:9981f62cdb1a	226	#ifdef DEBUG
Wolfgang Betz	130:770ce14d3d15	227	for(int i=0; i<buffSize+1; i++) {
Andrea Palmieri	236:2a73f3a97452	228	PRINTF("Advertising type: SERVICE_DATA loadPtr.getUnitAtIndex(index).getDataPtr()[%d] = 0x%x\n\r",
Andrea Palmieri	236:2a73f3a97452	229	i, loadPtr.getUnitAtIndex(index).getDataPtr()[i]);
Wolfgang Betz	130:770ce14d3d15	230	}
Andrea Palmieri	229:9981f62cdb1a	231	#endif
Wolfgang Betz	130:770ce14d3d15	232	AdvLen = buffSize+2; // the total ADV DATA LEN should include two more bytes: the buffer size byte; and the Service Data Type Value byte
Wolfgang Betz	130:770ce14d3d15	233	AdvData[0] = buffSize+1; // the fisrt byte is the data buffer size (type+data)
Wolfgang Betz	130:770ce14d3d15	234	AdvData[1] = AD_TYPE_SERVICE_DATA;
Wolfgang Betz	130:770ce14d3d15	235	memcpy(AdvData+2, loadPtr.getUnitAtIndex(index).getDataPtr(), buffSize);
Wolfgang Betz	130:770ce14d3d15	236	break;
Wolfgang Betz	130:770ce14d3d15	237	}
Andrea Palmieri	228:25368f053411	238
Wolfgang Betz	130:770ce14d3d15	239	case GapAdvertisingData::ADVERTISING_INTERVAL: /*< Advertising Interval /
Wolfgang Betz	130:770ce14d3d15	240	{
Wolfgang Betz	132:51056160fa4a	241	PRINTF("Advertising type: ADVERTISING_INTERVAL\n\r");
Andrea Palmieri	232:aead10288880	242	//uint32_t advInt = (uint32_t)(*loadPtr.getUnitAtIndex(index).getDataPtr());
Wolfgang Betz	130:770ce14d3d15	243	break;
Wolfgang Betz	130:770ce14d3d15	244	}
Andrea Palmieri	182:e7cff2f17ef9	245	case GapAdvertisingData::MANUFACTURER_SPECIFIC_DATA: /*< Manufacturer Specific Data /
Wolfgang Betz	130:770ce14d3d15	246	{
Andrea Palmieri	182:e7cff2f17ef9	247	PRINTF("Advertising type: MANUFACTURER_SPECIFIC_DATA\n\r");
Andrea Palmieri	182:e7cff2f17ef9	248	uint8_t buffSize = *loadPtr.getUnitAtIndex(index).getLenPtr()-1;
Andrea Palmieri	182:e7cff2f17ef9	249	PRINTF("Advertising type: MANUFACTURER_SPECIFIC_DATA (buffSize=%d)\n\r", buffSize);
Andrea Palmieri	182:e7cff2f17ef9	250	// the total ADV DATA LEN should include two more bytes:
Andrea Palmieri	182:e7cff2f17ef9	251	// the buffer size byte;
Andrea Palmieri	182:e7cff2f17ef9	252	// and the Manufacturer Specific Data Type Value byte
Andrea Palmieri	182:e7cff2f17ef9	253	if(buffSize>ADV_DATA_MAX_SIZE-2) {
Andrea Palmieri	182:e7cff2f17ef9	254	return BLE_ERROR_PARAM_OUT_OF_RANGE;
Andrea Palmieri	182:e7cff2f17ef9	255	}
Andrea Palmieri	229:9981f62cdb1a	256	#ifdef DBEUG
Andrea Palmieri	182:e7cff2f17ef9	257	for(int i=0; i<buffSize+1; i++) {
Andrea Palmieri	182:e7cff2f17ef9	258	PRINTF("Advertising type: MANUFACTURER_SPECIFIC_DATA loadPtr.getUnitAtIndex(index).getDataPtr()[%d] = 0x%x\n\r",
Andrea Palmieri	182:e7cff2f17ef9	259	i, loadPtr.getUnitAtIndex(index).getDataPtr()[i]);
Andrea Palmieri	182:e7cff2f17ef9	260	}
Andrea Palmieri	229:9981f62cdb1a	261	#endif
Andrea Palmieri	182:e7cff2f17ef9	262	AdvLen = buffSize+2; // the total ADV DATA LEN should include two more bytes: the buffer size byte; and the Manufacturer Specific Data Type Value byte
Andrea Palmieri	182:e7cff2f17ef9	263	AdvData[0] = buffSize+1; // the fisrt byte is the data buffer size (type+data)
Andrea Palmieri	182:e7cff2f17ef9	264	AdvData[1] = AD_TYPE_MANUFACTURER_SPECIFIC_DATA;
Andrea Palmieri	182:e7cff2f17ef9	265	memcpy(AdvData+2, loadPtr.getUnitAtIndex(index).getDataPtr(), buffSize);
Wolfgang Betz	130:770ce14d3d15	266	break;
Wolfgang Betz	130:770ce14d3d15	267	}
Andrea Palmieri	236:2a73f3a97452	268	} // end switch
Andrea Palmieri	236:2a73f3a97452	269
Andrea Palmieri	236:2a73f3a97452	270	} //end for
Andrea Palmieri	236:2a73f3a97452	271
Andrea Palmieri	236:2a73f3a97452	272	//Set the SCAN_RSP Payload
Andrea Palmieri	236:2a73f3a97452	273	if(scanResponse.getPayloadLen() > 0) {
Andrea Palmieri	236:2a73f3a97452	274	scan_response_payload = scanResponse.getPayload();
Andrea Palmieri	236:2a73f3a97452	275	scan_rsp_length = scanResponse.getPayloadLen();
Wolfgang Betz	130:770ce14d3d15	276	}
Andrea Palmieri	237:64c2ddbd9329	277
Andrea Palmieri	237:64c2ddbd9329	278	/* Align the GAP Service Appearance Char value coherently */
Andrea Palmieri	237:64c2ddbd9329	279	STORE_LE_16(deviceAppearance, advData.getAppearance());
Andrea Palmieri	237:64c2ddbd9329	280	setAppearance((GapAdvertisingData::Appearance)(deviceAppearance[1]<<8\|deviceAppearance[0]));
Andrea Palmieri	237:64c2ddbd9329	281
Andrea Palmieri	213:781abfbf2d1c	282	// Update the ADV data if we are already in ADV mode
Andrea Palmieri	213:781abfbf2d1c	283	if(AdvLen > 0 && state.advertising == 1) {
Andrea Palmieri	213:781abfbf2d1c	284
Andrea Palmieri	213:781abfbf2d1c	285	tBleStatus ret = aci_gap_update_adv_data(AdvLen, AdvData);
Andrea Palmieri	213:781abfbf2d1c	286	if(BLE_STATUS_SUCCESS!=ret) {
Andrea Palmieri	213:781abfbf2d1c	287	PRINTF("error occurred while adding adv data (ret=0x%x)\n", ret);
Andrea Palmieri	213:781abfbf2d1c	288	switch (ret) {
Andrea Palmieri	238:b6454c839f42	289	case BLE_STATUS_TIMEOUT:
Andrea Palmieri	238:b6454c839f42	290	return BLE_STACK_BUSY;
Andrea Palmieri	238:b6454c839f42	291	case ERR_INVALID_HCI_CMD_PARAMS:
Andrea Palmieri	238:b6454c839f42	292	case BLE_STATUS_INVALID_PARAMS:
Andrea Palmieri	238:b6454c839f42	293	return BLE_ERROR_INVALID_PARAM;
Andrea Palmieri	238:b6454c839f42	294	case BLE_STATUS_FAILED:
Andrea Palmieri	238:b6454c839f42	295	return BLE_ERROR_PARAM_OUT_OF_RANGE;
Andrea Palmieri	238:b6454c839f42	296	default:
Andrea Palmieri	238:b6454c839f42	297	return BLE_ERROR_UNSPECIFIED;
Andrea Palmieri	213:781abfbf2d1c	298	}
Andrea Palmieri	213:781abfbf2d1c	299	}
Andrea Palmieri	213:781abfbf2d1c	300	}
Wolfgang Betz	130:770ce14d3d15	301	}
Wolfgang Betz	130:770ce14d3d15	302	return BLE_ERROR_NONE;
Wolfgang Betz	130:770ce14d3d15	303	}
Wolfgang Betz	130:770ce14d3d15	304
Wolfgang Betz	130:770ce14d3d15	305	/*
Wolfgang Betz	130:770ce14d3d15	306	* Utility to set ADV timeout flag
Wolfgang Betz	130:770ce14d3d15	307	*/
Wolfgang Betz	130:770ce14d3d15	308	void BlueNRGGap::setAdvToFlag(void) {
Wolfgang Betz	130:770ce14d3d15	309	AdvToFlag = true;
Wolfgang Betz	130:770ce14d3d15	310	}
Wolfgang Betz	130:770ce14d3d15	311
Wolfgang Betz	130:770ce14d3d15	312	/*
Wolfgang Betz	130:770ce14d3d15	313	* ADV timeout callback
Andrea Palmieri	229:9981f62cdb1a	314	*/
Wolfgang Betz	138:32e3c4ca7a45	315	#ifdef AST_FOR_MBED_OS
Wolfgang Betz	132:51056160fa4a	316	static void advTimeoutCB(void)
Wolfgang Betz	132:51056160fa4a	317	{
Wolfgang Betz	132:51056160fa4a	318	Gap::GapState_t state;
Wolfgang Betz	132:51056160fa4a	319
Wolfgang Betz	132:51056160fa4a	320	state = BlueNRGGap::getInstance().getState();
Wolfgang Betz	132:51056160fa4a	321	if (state.advertising == 1) {
Wolfgang Betz	132:51056160fa4a	322
Wolfgang Betz	132:51056160fa4a	323	BlueNRGGap::getInstance().stopAdvertising();
Wolfgang Betz	132:51056160fa4a	324
Wolfgang Betz	132:51056160fa4a	325	}
Wolfgang Betz	132:51056160fa4a	326	}
Wolfgang Betz	132:51056160fa4a	327	#else
Wolfgang Betz	130:770ce14d3d15	328	static void advTimeoutCB(void)
Wolfgang Betz	130:770ce14d3d15	329	{
Wolfgang Betz	130:770ce14d3d15	330	Gap::GapState_t state;
Wolfgang Betz	130:770ce14d3d15	331
Wolfgang Betz	130:770ce14d3d15	332	state = BlueNRGGap::getInstance().getState();
Wolfgang Betz	130:770ce14d3d15	333	if (state.advertising == 1) {
Wolfgang Betz	130:770ce14d3d15	334
Wolfgang Betz	130:770ce14d3d15	335	BlueNRGGap::getInstance().setAdvToFlag();
Wolfgang Betz	130:770ce14d3d15	336
Wolfgang Betz	130:770ce14d3d15	337	Timeout t = BlueNRGGap::getInstance().getAdvTimeout();
Wolfgang Betz	130:770ce14d3d15	338	t.detach(); /* disable the callback from the timeout */
Wolfgang Betz	130:770ce14d3d15	339
Wolfgang Betz	130:770ce14d3d15	340	}
Wolfgang Betz	130:770ce14d3d15	341	}
Wolfgang Betz	138:32e3c4ca7a45	342	#endif /* AST_FOR_MBED_OS */
Wolfgang Betz	130:770ce14d3d15	343
Wolfgang Betz	130:770ce14d3d15	344	/**************************************************************************/
Wolfgang Betz	130:770ce14d3d15	345	/*!
Wolfgang Betz	130:770ce14d3d15	346	@brief Starts the BLE HW, initialising any services that were
Wolfgang Betz	130:770ce14d3d15	347	added before this function was called.
Wolfgang Betz	130:770ce14d3d15	348
Wolfgang Betz	130:770ce14d3d15	349	@param[in] params
Wolfgang Betz	130:770ce14d3d15	350	Basic advertising details, including the advertising
Wolfgang Betz	130:770ce14d3d15	351	delay, timeout and how the device should be advertised
Wolfgang Betz	130:770ce14d3d15	352
Wolfgang Betz	130:770ce14d3d15	353	@note All services must be added before calling this function!
Wolfgang Betz	130:770ce14d3d15	354
Wolfgang Betz	130:770ce14d3d15	355	@returns ble_error_t
Wolfgang Betz	130:770ce14d3d15	356
Wolfgang Betz	130:770ce14d3d15	357	@retval BLE_ERROR_NONE
Wolfgang Betz	130:770ce14d3d15	358	Everything executed properly
Wolfgang Betz	130:770ce14d3d15	359
Wolfgang Betz	130:770ce14d3d15	360	@section EXAMPLE
Wolfgang Betz	130:770ce14d3d15	361
Wolfgang Betz	130:770ce14d3d15	362	@code
Wolfgang Betz	130:770ce14d3d15	363
Wolfgang Betz	130:770ce14d3d15	364	@endcode
Wolfgang Betz	130:770ce14d3d15	365	*/
Wolfgang Betz	130:770ce14d3d15	366	/**************************************************************************/
Wolfgang Betz	130:770ce14d3d15	367
Wolfgang Betz	130:770ce14d3d15	368	ble_error_t BlueNRGGap::startAdvertising(const GapAdvertisingParams &params)
Andrea Palmieri	187:2e517d3ddd71	369	{
Andrea Palmieri	187:2e517d3ddd71	370	tBleStatus ret;
Andrea Palmieri	238:b6454c839f42	371	ble_error_t rc;
Andrea Palmieri	187:2e517d3ddd71	372
Wolfgang Betz	130:770ce14d3d15	373	/* Make sure we support the advertising type */
Wolfgang Betz	130:770ce14d3d15	374	if (params.getAdvertisingType() == GapAdvertisingParams::ADV_CONNECTABLE_DIRECTED) {
Andrea Palmieri	220:e02936f0d4c7	375	/* ToDo: This requires a proper security implementation, etc. */
Wolfgang Betz	130:770ce14d3d15	376	return BLE_ERROR_NOT_IMPLEMENTED;
Wolfgang Betz	130:770ce14d3d15	377	}
Wolfgang Betz	130:770ce14d3d15	378
Wolfgang Betz	130:770ce14d3d15	379	/* Check interval range */
Wolfgang Betz	130:770ce14d3d15	380	if (params.getAdvertisingType() == GapAdvertisingParams::ADV_NON_CONNECTABLE_UNDIRECTED) {
Wolfgang Betz	130:770ce14d3d15	381	/* Min delay is slightly longer for unconnectable devices */
Wolfgang Betz	130:770ce14d3d15	382	if ((params.getIntervalInADVUnits() < GapAdvertisingParams::GAP_ADV_PARAMS_INTERVAL_MIN_NONCON) \|\|
Wolfgang Betz	130:770ce14d3d15	383	(params.getIntervalInADVUnits() > GapAdvertisingParams::GAP_ADV_PARAMS_INTERVAL_MAX)) {
Wolfgang Betz	130:770ce14d3d15	384	return BLE_ERROR_PARAM_OUT_OF_RANGE;
Wolfgang Betz	130:770ce14d3d15	385	}
Wolfgang Betz	130:770ce14d3d15	386	} else {
Wolfgang Betz	130:770ce14d3d15	387	if ((params.getIntervalInADVUnits() < GapAdvertisingParams::GAP_ADV_PARAMS_INTERVAL_MIN) \|\|
Wolfgang Betz	130:770ce14d3d15	388	(params.getIntervalInADVUnits() > GapAdvertisingParams::GAP_ADV_PARAMS_INTERVAL_MAX)) {
Wolfgang Betz	130:770ce14d3d15	389	return BLE_ERROR_PARAM_OUT_OF_RANGE;
Wolfgang Betz	130:770ce14d3d15	390	}
Wolfgang Betz	130:770ce14d3d15	391	}
Wolfgang Betz	130:770ce14d3d15	392
Wolfgang Betz	130:770ce14d3d15	393	/* Check timeout is zero for Connectable Directed */
Wolfgang Betz	130:770ce14d3d15	394	if ((params.getAdvertisingType() == GapAdvertisingParams::ADV_CONNECTABLE_DIRECTED) && (params.getTimeout() != 0)) {
Wolfgang Betz	130:770ce14d3d15	395	/* Timeout must be 0 with this type, although we'll never get here */
Wolfgang Betz	130:770ce14d3d15	396	/* since this isn't implemented yet anyway */
Wolfgang Betz	130:770ce14d3d15	397	return BLE_ERROR_PARAM_OUT_OF_RANGE;
Wolfgang Betz	130:770ce14d3d15	398	}
Wolfgang Betz	130:770ce14d3d15	399
Wolfgang Betz	130:770ce14d3d15	400	/* Check timeout for other advertising types */
Wolfgang Betz	130:770ce14d3d15	401	if ((params.getAdvertisingType() != GapAdvertisingParams::ADV_CONNECTABLE_DIRECTED) &&
Wolfgang Betz	130:770ce14d3d15	402	(params.getTimeout() > GapAdvertisingParams::GAP_ADV_PARAMS_TIMEOUT_MAX)) {
Wolfgang Betz	130:770ce14d3d15	403	return BLE_ERROR_PARAM_OUT_OF_RANGE;
Wolfgang Betz	130:770ce14d3d15	404	}
Wolfgang Betz	130:770ce14d3d15	405
Andrea Palmieri	229:9981f62cdb1a	406	/*
Andrea Palmieri	229:9981f62cdb1a	407	* Advertising filter policy setting
Andrea Palmieri	229:9981f62cdb1a	408	* FIXME: the Security Manager should be implemented
Andrea Palmieri	229:9981f62cdb1a	409	*/
Andrea Palmieri	229:9981f62cdb1a	410	AdvertisingPolicyMode_t mode = getAdvertisingPolicyMode();
Andrea Palmieri	229:9981f62cdb1a	411	if(mode != ADV_POLICY_IGNORE_WHITELIST) {
Andrea Palmieri	229:9981f62cdb1a	412	ret = aci_gap_configure_whitelist();
Andrea Palmieri	229:9981f62cdb1a	413	if(ret != BLE_STATUS_SUCCESS) {
Andrea Palmieri	229:9981f62cdb1a	414	PRINTF("aci_gap_configure_whitelist ret=0x%x\n\r", ret);
Andrea Palmieri	229:9981f62cdb1a	415	return BLE_ERROR_OPERATION_NOT_PERMITTED;
Andrea Palmieri	229:9981f62cdb1a	416	}
Andrea Palmieri	229:9981f62cdb1a	417	}
Andrea Palmieri	229:9981f62cdb1a	418
Andrea Palmieri	229:9981f62cdb1a	419	uint8_t advFilterPolicy = NO_WHITE_LIST_USE;
Andrea Palmieri	229:9981f62cdb1a	420	switch(mode) {
Andrea Palmieri	229:9981f62cdb1a	421	case ADV_POLICY_FILTER_SCAN_REQS:
Andrea Palmieri	229:9981f62cdb1a	422	advFilterPolicy = WHITE_LIST_FOR_ONLY_SCAN;
Andrea Palmieri	229:9981f62cdb1a	423	break;
Andrea Palmieri	229:9981f62cdb1a	424	case ADV_POLICY_FILTER_CONN_REQS:
Andrea Palmieri	229:9981f62cdb1a	425	advFilterPolicy = WHITE_LIST_FOR_ONLY_CONN;
Andrea Palmieri	229:9981f62cdb1a	426	break;
Andrea Palmieri	229:9981f62cdb1a	427	case ADV_POLICY_FILTER_ALL_REQS:
Andrea Palmieri	229:9981f62cdb1a	428	advFilterPolicy = WHITE_LIST_FOR_ALL;
Andrea Palmieri	229:9981f62cdb1a	429	break;
Andrea Palmieri	229:9981f62cdb1a	430	default:
Andrea Palmieri	229:9981f62cdb1a	431	advFilterPolicy = NO_WHITE_LIST_USE;
Andrea Palmieri	229:9981f62cdb1a	432	break;
Andrea Palmieri	229:9981f62cdb1a	433	}
Andrea Palmieri	229:9981f62cdb1a	434
Andrea Palmieri	228:25368f053411	435	/* Check the ADV type before setting scan response data */
Andrea Palmieri	228:25368f053411	436	if (params.getAdvertisingType() == GapAdvertisingParams::ADV_CONNECTABLE_UNDIRECTED \|\|
Andrea Palmieri	228:25368f053411	437	params.getAdvertisingType() == GapAdvertisingParams::ADV_SCANNABLE_UNDIRECTED) {
Andrea Palmieri	228:25368f053411	438
Andrea Palmieri	228:25368f053411	439	/* set scan response data */
Andrea Palmieri	228:25368f053411	440	PRINTF(" setting scan response data (scan_rsp_length=%u)\n", scan_rsp_length);
Andrea Palmieri	228:25368f053411	441	ret = hci_le_set_scan_resp_data(scan_rsp_length, scan_response_payload);
Andrea Palmieri	228:25368f053411	442
Andrea Palmieri	228:25368f053411	443	if(BLE_STATUS_SUCCESS!=ret) {
Andrea Palmieri	228:25368f053411	444	PRINTF(" error while setting scan response data (ret=0x%x)\n", ret);
Andrea Palmieri	228:25368f053411	445	switch (ret) {
Andrea Palmieri	228:25368f053411	446	case BLE_STATUS_TIMEOUT:
Andrea Palmieri	228:25368f053411	447	return BLE_STACK_BUSY;
Andrea Palmieri	228:25368f053411	448	default:
Andrea Palmieri	228:25368f053411	449	return BLE_ERROR_UNSPECIFIED;
Andrea Palmieri	228:25368f053411	450	}
Andrea Palmieri	187:2e517d3ddd71	451	}
Andrea Palmieri	228:25368f053411	452	} else {
Andrea Palmieri	228:25368f053411	453	hci_le_set_scan_resp_data(0, NULL);
Andrea Palmieri	187:2e517d3ddd71	454	}
Wolfgang Betz	130:770ce14d3d15	455
Andrea Palmieri	232:aead10288880	456	//advInterval = params.getIntervalInADVUnits();
Andrea Palmieri	232:aead10288880	457	setAdvParameters();
Andrea Palmieri	232:aead10288880	458	PRINTF("advInterval=%d advType=%d\n\r", advInterval, params.getAdvertisingType());
Wolfgang Betz	130:770ce14d3d15	459
Andrea Palmieri	229:9981f62cdb1a	460	/* Setting discoverable mode */
Andrea Palmieri	220:e02936f0d4c7	461	ret = aci_gap_set_discoverable(params.getAdvertisingType(), // AdvType
Andrea Palmieri	232:aead10288880	462	advInterval, // AdvIntervMin
Andrea Palmieri	232:aead10288880	463	advInterval, // AdvIntervMax
Andrea Palmieri	228:25368f053411	464	addr_type, // OwnAddrType
Andrea Palmieri	229:9981f62cdb1a	465	advFilterPolicy, // AdvFilterPolicy
Andrea Palmieri	220:e02936f0d4c7	466	local_name_length, // LocalNameLen
Andrea Palmieri	220:e02936f0d4c7	467	(const char*)local_name, // LocalName
Andrea Palmieri	220:e02936f0d4c7	468	servUuidlength, // ServiceUUIDLen
Andrea Palmieri	220:e02936f0d4c7	469	servUuidData, // ServiceUUIDList
Andrea Palmieri	220:e02936f0d4c7	470	0, // SlaveConnIntervMin
Andrea Palmieri	220:e02936f0d4c7	471	0); // SlaveConnIntervMax
Wolfgang Betz	130:770ce14d3d15	472
Wolfgang Betz	130:770ce14d3d15	473
Andrea Palmieri	229:9981f62cdb1a	474	PRINTF("!!!setting discoverable (servUuidlength=0x%x)\n\r", servUuidlength);
Wolfgang Betz	130:770ce14d3d15	475	if(BLE_STATUS_SUCCESS!=ret) {
Andrea Palmieri	229:9981f62cdb1a	476	PRINTF("error occurred while setting discoverable (ret=0x%x)\n\r", ret);
Andrea Palmieri	187:2e517d3ddd71	477	switch (ret) {
Andrea Palmieri	187:2e517d3ddd71	478	case BLE_STATUS_INVALID_PARAMS:
Andrea Palmieri	187:2e517d3ddd71	479	return BLE_ERROR_INVALID_PARAM;
Andrea Palmieri	187:2e517d3ddd71	480	case ERR_COMMAND_DISALLOWED:
Andrea Palmieri	187:2e517d3ddd71	481	return BLE_ERROR_OPERATION_NOT_PERMITTED;
Andrea Palmieri	187:2e517d3ddd71	482	case ERR_UNSUPPORTED_FEATURE:
Andrea Palmieri	187:2e517d3ddd71	483	return BLE_ERROR_NOT_IMPLEMENTED;
Andrea Palmieri	187:2e517d3ddd71	484	case BLE_STATUS_TIMEOUT:
Andrea Palmieri	187:2e517d3ddd71	485	return BLE_STACK_BUSY;
Andrea Palmieri	187:2e517d3ddd71	486	default:
Andrea Palmieri	187:2e517d3ddd71	487	return BLE_ERROR_UNSPECIFIED;
Andrea Palmieri	187:2e517d3ddd71	488	}
Wolfgang Betz	130:770ce14d3d15	489	}
Wolfgang Betz	130:770ce14d3d15	490
Andrea Palmieri	238:b6454c839f42	491	// Stop Advertising if an error occurs while updating ADV data
Andrea Palmieri	238:b6454c839f42	492	rc = updateAdvertisingData();
Andrea Palmieri	238:b6454c839f42	493	if(rc != BLE_ERROR_NONE) {
Andrea Palmieri	238:b6454c839f42	494	aci_gap_set_non_discoverable();
Andrea Palmieri	238:b6454c839f42	495	return rc;
Andrea Palmieri	228:25368f053411	496	}
Andrea Palmieri	228:25368f053411	497
Wolfgang Betz	130:770ce14d3d15	498	state.advertising = 1;
Wolfgang Betz	130:770ce14d3d15	499
Wolfgang Betz	130:770ce14d3d15	500	AdvToFlag = false;
Wolfgang Betz	130:770ce14d3d15	501	if(params.getTimeout() != 0) {
Wolfgang Betz	132:51056160fa4a	502	PRINTF("!!! attaching to!!!\n");
Wolfgang Betz	138:32e3c4ca7a45	503	#ifdef AST_FOR_MBED_OS
Andrea Palmieri	229:9981f62cdb1a	504	minar::Scheduler::postCallback(advTimeoutCB).delay(minar::milliseconds(params.getTimeout() * 1000));
Wolfgang Betz	132:51056160fa4a	505	#else
Andrea Palmieri	229:9981f62cdb1a	506	advTimeout.attach(advTimeoutCB, params.getTimeout() * 1000);
Wolfgang Betz	132:51056160fa4a	507	#endif
Wolfgang Betz	130:770ce14d3d15	508	}
Andrea Palmieri	238:b6454c839f42	509
Wolfgang Betz	130:770ce14d3d15	510	return BLE_ERROR_NONE;
Wolfgang Betz	130:770ce14d3d15	511	}
Wolfgang Betz	130:770ce14d3d15	512
Andrea Palmieri	238:b6454c839f42	513	ble_error_t BlueNRGGap::updateAdvertisingData(void)
Andrea Palmieri	238:b6454c839f42	514	{
Andrea Palmieri	238:b6454c839f42	515	tBleStatus ret;
Andrea Palmieri	238:b6454c839f42	516
Andrea Palmieri	238:b6454c839f42	517	// Before updating the ADV data, delete COMPLETE_LOCAL_NAME and TX_POWER_LEVEL fields (if present)
Andrea Palmieri	238:b6454c839f42	518	if(AdvLen > 0) {
Andrea Palmieri	238:b6454c839f42	519	if(local_name_length > 0) {
Andrea Palmieri	238:b6454c839f42	520	ret = aci_gap_delete_ad_type(AD_TYPE_COMPLETE_LOCAL_NAME);
Andrea Palmieri	238:b6454c839f42	521	if (BLE_STATUS_SUCCESS!=ret){
Andrea Palmieri	238:b6454c839f42	522	PRINTF("aci_gap_delete_ad_type failed return=%d\n", ret);
Andrea Palmieri	238:b6454c839f42	523	switch (ret) {
Andrea Palmieri	238:b6454c839f42	524	case BLE_STATUS_TIMEOUT:
Andrea Palmieri	238:b6454c839f42	525	return BLE_STACK_BUSY;
Andrea Palmieri	238:b6454c839f42	526	case ERR_COMMAND_DISALLOWED:
Andrea Palmieri	238:b6454c839f42	527	return BLE_ERROR_OPERATION_NOT_PERMITTED;
Andrea Palmieri	238:b6454c839f42	528	case ERR_INVALID_HCI_CMD_PARAMS:
Andrea Palmieri	238:b6454c839f42	529	return BLE_ERROR_INVALID_PARAM;
Andrea Palmieri	238:b6454c839f42	530	default:
Andrea Palmieri	238:b6454c839f42	531	return BLE_ERROR_UNSPECIFIED;
Andrea Palmieri	238:b6454c839f42	532	}
Andrea Palmieri	238:b6454c839f42	533	}
Andrea Palmieri	238:b6454c839f42	534	}
Andrea Palmieri	238:b6454c839f42	535
Andrea Palmieri	238:b6454c839f42	536	// If ADV Data Type is SERVICE DATA or MANUFACTURER SPECIFIC DATA,
Andrea Palmieri	238:b6454c839f42	537	// we need to delete it to make the needed room in ADV payload
Andrea Palmieri	238:b6454c839f42	538	if(AdvData[1]==AD_TYPE_SERVICE_DATA \|\| AdvData[1]==AD_TYPE_MANUFACTURER_SPECIFIC_DATA) {
Andrea Palmieri	238:b6454c839f42	539	ret = aci_gap_delete_ad_type(AD_TYPE_TX_POWER_LEVEL);
Andrea Palmieri	238:b6454c839f42	540	if (BLE_STATUS_SUCCESS!=ret){
Andrea Palmieri	238:b6454c839f42	541	PRINTF("aci_gap_delete_ad_type failed return=%d\n", ret);
Andrea Palmieri	238:b6454c839f42	542	switch (ret) {
Andrea Palmieri	238:b6454c839f42	543	case BLE_STATUS_TIMEOUT:
Andrea Palmieri	238:b6454c839f42	544	return BLE_STACK_BUSY;
Andrea Palmieri	238:b6454c839f42	545	case ERR_COMMAND_DISALLOWED:
Andrea Palmieri	238:b6454c839f42	546	return BLE_ERROR_OPERATION_NOT_PERMITTED;
Andrea Palmieri	238:b6454c839f42	547	case ERR_INVALID_HCI_CMD_PARAMS:
Andrea Palmieri	238:b6454c839f42	548	return BLE_ERROR_INVALID_PARAM;
Andrea Palmieri	238:b6454c839f42	549	default:
Andrea Palmieri	238:b6454c839f42	550	return BLE_ERROR_UNSPECIFIED;
Andrea Palmieri	238:b6454c839f42	551	}
Andrea Palmieri	238:b6454c839f42	552	}
Andrea Palmieri	238:b6454c839f42	553	}
Andrea Palmieri	238:b6454c839f42	554
Andrea Palmieri	238:b6454c839f42	555	ret = aci_gap_update_adv_data(AdvLen, AdvData);
Andrea Palmieri	238:b6454c839f42	556	if(BLE_STATUS_SUCCESS!=ret) {
Andrea Palmieri	238:b6454c839f42	557	PRINTF("error occurred while adding adv data (ret=0x%x)\n\r", ret);
Andrea Palmieri	238:b6454c839f42	558	switch (ret) {
Andrea Palmieri	238:b6454c839f42	559	case BLE_STATUS_TIMEOUT:
Andrea Palmieri	238:b6454c839f42	560	return BLE_STACK_BUSY;
Andrea Palmieri	238:b6454c839f42	561	case ERR_INVALID_HCI_CMD_PARAMS:
Andrea Palmieri	238:b6454c839f42	562	case BLE_STATUS_INVALID_PARAMS:
Andrea Palmieri	238:b6454c839f42	563	return BLE_ERROR_INVALID_PARAM;
Andrea Palmieri	238:b6454c839f42	564	case BLE_STATUS_FAILED:
Andrea Palmieri	238:b6454c839f42	565	return BLE_ERROR_PARAM_OUT_OF_RANGE;
Andrea Palmieri	238:b6454c839f42	566	default:
Andrea Palmieri	238:b6454c839f42	567	return BLE_ERROR_UNSPECIFIED;
Andrea Palmieri	238:b6454c839f42	568	}
Andrea Palmieri	238:b6454c839f42	569	}
Andrea Palmieri	238:b6454c839f42	570
Andrea Palmieri	238:b6454c839f42	571	} // AdvLen>0
Andrea Palmieri	238:b6454c839f42	572
Andrea Palmieri	238:b6454c839f42	573	if(deviceAppearance != 0) {
Andrea Palmieri	238:b6454c839f42	574	uint8_t appearance[] = {3, AD_TYPE_APPEARANCE, deviceAppearance[0], deviceAppearance[1]};
Andrea Palmieri	238:b6454c839f42	575	// just ignore error code while setting appearance
Andrea Palmieri	238:b6454c839f42	576	aci_gap_update_adv_data(4, appearance);
Andrea Palmieri	238:b6454c839f42	577	}
Andrea Palmieri	238:b6454c839f42	578
Andrea Palmieri	238:b6454c839f42	579	return BLE_ERROR_NONE;
Andrea Palmieri	238:b6454c839f42	580
Andrea Palmieri	238:b6454c839f42	581	}
Andrea Palmieri	238:b6454c839f42	582
Wolfgang Betz	130:770ce14d3d15	583	/**************************************************************************/
Wolfgang Betz	130:770ce14d3d15	584	/*!
Wolfgang Betz	130:770ce14d3d15	585	@brief Stops the BLE HW and disconnects from any devices
Wolfgang Betz	130:770ce14d3d15	586
Wolfgang Betz	130:770ce14d3d15	587	@returns ble_error_t
Wolfgang Betz	130:770ce14d3d15	588
Wolfgang Betz	130:770ce14d3d15	589	@retval BLE_ERROR_NONE
Wolfgang Betz	130:770ce14d3d15	590	Everything executed properly
Wolfgang Betz	130:770ce14d3d15	591
Wolfgang Betz	130:770ce14d3d15	592	@section EXAMPLE
Wolfgang Betz	130:770ce14d3d15	593
Wolfgang Betz	130:770ce14d3d15	594	@code
Wolfgang Betz	130:770ce14d3d15	595
Wolfgang Betz	130:770ce14d3d15	596	@endcode
Wolfgang Betz	130:770ce14d3d15	597	*/
Wolfgang Betz	130:770ce14d3d15	598	/**************************************************************************/
Wolfgang Betz	130:770ce14d3d15	599	ble_error_t BlueNRGGap::stopAdvertising(void)
Wolfgang Betz	130:770ce14d3d15	600	{
Wolfgang Betz	130:770ce14d3d15	601	tBleStatus ret;
Andrea Palmieri	229:9981f62cdb1a	602
Wolfgang Betz	130:770ce14d3d15	603	if(state.advertising == 1) {
Wolfgang Betz	130:770ce14d3d15	604	//Set non-discoverable to stop advertising
Wolfgang Betz	130:770ce14d3d15	605	ret = aci_gap_set_non_discoverable();
Wolfgang Betz	130:770ce14d3d15	606
Andrea Palmieri	187:2e517d3ddd71	607	if (BLE_STATUS_SUCCESS!=ret){
Wolfgang Betz	132:51056160fa4a	608	PRINTF("Error in stopping advertisement (ret=0x%x)!!\n\r", ret) ;
Andrea Palmieri	187:2e517d3ddd71	609	switch (ret) {
Andrea Palmieri	187:2e517d3ddd71	610	case ERR_COMMAND_DISALLOWED:
Andrea Palmieri	187:2e517d3ddd71	611	return BLE_ERROR_OPERATION_NOT_PERMITTED;
Andrea Palmieri	187:2e517d3ddd71	612	case BLE_STATUS_TIMEOUT:
Andrea Palmieri	187:2e517d3ddd71	613	return BLE_STACK_BUSY;
Andrea Palmieri	187:2e517d3ddd71	614	default:
Andrea Palmieri	187:2e517d3ddd71	615	return BLE_ERROR_UNSPECIFIED;
Andrea Palmieri	187:2e517d3ddd71	616	}
Wolfgang Betz	130:770ce14d3d15	617	}
Wolfgang Betz	132:51056160fa4a	618	PRINTF("Advertisement stopped!!\n\r") ;
Wolfgang Betz	130:770ce14d3d15	619	//Set GapState_t::advertising state
Wolfgang Betz	130:770ce14d3d15	620	state.advertising = 0;
Wolfgang Betz	130:770ce14d3d15	621	}
Wolfgang Betz	130:770ce14d3d15	622
Wolfgang Betz	130:770ce14d3d15	623	return BLE_ERROR_NONE;
Wolfgang Betz	130:770ce14d3d15	624	}
Wolfgang Betz	130:770ce14d3d15	625
Wolfgang Betz	130:770ce14d3d15	626	/**************************************************************************/
Wolfgang Betz	130:770ce14d3d15	627	/*!
Wolfgang Betz	130:770ce14d3d15	628	@brief Disconnects if we are connected to a central device
Wolfgang Betz	130:770ce14d3d15	629
Wolfgang Betz	130:770ce14d3d15	630	@param[in] reason
Wolfgang Betz	130:770ce14d3d15	631	Disconnection Reason
Wolfgang Betz	130:770ce14d3d15	632
Wolfgang Betz	130:770ce14d3d15	633	@returns ble_error_t
Wolfgang Betz	130:770ce14d3d15	634
Wolfgang Betz	130:770ce14d3d15	635	@retval BLE_ERROR_NONE
Wolfgang Betz	130:770ce14d3d15	636	Everything executed properly
Wolfgang Betz	130:770ce14d3d15	637
Wolfgang Betz	130:770ce14d3d15	638	@section EXAMPLE
Wolfgang Betz	130:770ce14d3d15	639
Wolfgang Betz	130:770ce14d3d15	640	@code
Wolfgang Betz	130:770ce14d3d15	641
Wolfgang Betz	130:770ce14d3d15	642	@endcode
Wolfgang Betz	130:770ce14d3d15	643	*/
Wolfgang Betz	130:770ce14d3d15	644	/**************************************************************************/
Andrea Palmieri	239:8e93d6e26c55	645	ble_error_t BlueNRGGap::disconnect(Handle_t connectionHandle, Gap::DisconnectionReason_t reason)
Wolfgang Betz	130:770ce14d3d15	646	{
Andrea Palmieri	239:8e93d6e26c55	647	tBleStatus ret;
Andrea Palmieri	142:adf1567d3900	648
Andrea Palmieri	239:8e93d6e26c55	649	ret = aci_gap_terminate(connectionHandle, reason);
Wolfgang Betz	130:770ce14d3d15	650
Andrea Palmieri	239:8e93d6e26c55	651	if (BLE_STATUS_SUCCESS != ret){
Andrea Palmieri	239:8e93d6e26c55	652	PRINTF("Error in GAP termination (ret=0x%x)!!\n\r", ret) ;
Andrea Palmieri	239:8e93d6e26c55	653	switch (ret) {
Andrea Palmieri	239:8e93d6e26c55	654	case ERR_COMMAND_DISALLOWED:
Andrea Palmieri	239:8e93d6e26c55	655	return BLE_ERROR_OPERATION_NOT_PERMITTED;
Andrea Palmieri	239:8e93d6e26c55	656	case BLE_STATUS_TIMEOUT:
Andrea Palmieri	239:8e93d6e26c55	657	return BLE_STACK_BUSY;
Andrea Palmieri	239:8e93d6e26c55	658	default:
Andrea Palmieri	239:8e93d6e26c55	659	return BLE_ERROR_UNSPECIFIED;
Wolfgang Betz	130:770ce14d3d15	660	}
Wolfgang Betz	130:770ce14d3d15	661	}
Wolfgang Betz	130:770ce14d3d15	662
Wolfgang Betz	130:770ce14d3d15	663	return BLE_ERROR_NONE;
Wolfgang Betz	130:770ce14d3d15	664	}
Wolfgang Betz	130:770ce14d3d15	665
Wolfgang Betz	130:770ce14d3d15	666	/**************************************************************************/
Wolfgang Betz	130:770ce14d3d15	667	/*!
Wolfgang Betz	130:770ce14d3d15	668	@brief Disconnects if we are connected to a central device
Wolfgang Betz	130:770ce14d3d15	669
Wolfgang Betz	130:770ce14d3d15	670	@param[in] reason
Wolfgang Betz	130:770ce14d3d15	671	Disconnection Reason
Wolfgang Betz	130:770ce14d3d15	672
Wolfgang Betz	130:770ce14d3d15	673	@returns ble_error_t
Wolfgang Betz	130:770ce14d3d15	674
Wolfgang Betz	130:770ce14d3d15	675	@retval BLE_ERROR_NONE
Wolfgang Betz	130:770ce14d3d15	676	Everything executed properly
Wolfgang Betz	130:770ce14d3d15	677
Wolfgang Betz	130:770ce14d3d15	678	@section EXAMPLE
Wolfgang Betz	130:770ce14d3d15	679
Wolfgang Betz	130:770ce14d3d15	680	@code
Wolfgang Betz	130:770ce14d3d15	681
Wolfgang Betz	130:770ce14d3d15	682	@endcode
Wolfgang Betz	130:770ce14d3d15	683	*/
Wolfgang Betz	130:770ce14d3d15	684	/**************************************************************************/
Andrea Palmieri	239:8e93d6e26c55	685	ble_error_t BlueNRGGap::disconnect(Gap::DisconnectionReason_t reason)
Wolfgang Betz	130:770ce14d3d15	686	{
Andrea Palmieri	239:8e93d6e26c55	687	return disconnect(m_connectionHandle, reason);
Wolfgang Betz	130:770ce14d3d15	688	}
Wolfgang Betz	130:770ce14d3d15	689
Wolfgang Betz	130:770ce14d3d15	690	/**************************************************************************/
Wolfgang Betz	130:770ce14d3d15	691	/*!
Wolfgang Betz	130:770ce14d3d15	692	@brief Sets the 16-bit connection handle
Wolfgang Betz	130:770ce14d3d15	693
Andrea Palmieri	239:8e93d6e26c55	694	@param[in] conn_handle
Wolfgang Betz	130:770ce14d3d15	695	Connection Handle which is set in the Gap Instance
Wolfgang Betz	130:770ce14d3d15	696
Wolfgang Betz	130:770ce14d3d15	697	@returns void
Wolfgang Betz	130:770ce14d3d15	698	*/
Wolfgang Betz	130:770ce14d3d15	699	/**************************************************************************/
Andrea Palmieri	239:8e93d6e26c55	700	void BlueNRGGap::setConnectionHandle(uint16_t conn_handle)
Wolfgang Betz	130:770ce14d3d15	701	{
Andrea Palmieri	239:8e93d6e26c55	702	m_connectionHandle = conn_handle;
Wolfgang Betz	130:770ce14d3d15	703	}
Wolfgang Betz	130:770ce14d3d15	704
Wolfgang Betz	130:770ce14d3d15	705	/**************************************************************************/
Wolfgang Betz	130:770ce14d3d15	706	/*!
Wolfgang Betz	130:770ce14d3d15	707	@brief Gets the 16-bit connection handle
Wolfgang Betz	130:770ce14d3d15	708
Wolfgang Betz	130:770ce14d3d15	709	@param[in] void
Wolfgang Betz	130:770ce14d3d15	710
Wolfgang Betz	130:770ce14d3d15	711	@returns uint16_t
Wolfgang Betz	130:770ce14d3d15	712	Connection Handle of the Gap Instance
Wolfgang Betz	130:770ce14d3d15	713	*/
Wolfgang Betz	130:770ce14d3d15	714	/**************************************************************************/
Wolfgang Betz	130:770ce14d3d15	715	uint16_t BlueNRGGap::getConnectionHandle(void)
Wolfgang Betz	130:770ce14d3d15	716	{
Wolfgang Betz	130:770ce14d3d15	717	return m_connectionHandle;
Wolfgang Betz	130:770ce14d3d15	718	}
Wolfgang Betz	130:770ce14d3d15	719
Wolfgang Betz	130:770ce14d3d15	720	/**************************************************************************/
Wolfgang Betz	130:770ce14d3d15	721	/*!
Wolfgang Betz	130:770ce14d3d15	722	@brief Sets the BLE device address. SetAddress will reset the BLE
Wolfgang Betz	130:770ce14d3d15	723	device and re-initialize BTLE. Will not start advertising.
Wolfgang Betz	130:770ce14d3d15	724
Wolfgang Betz	130:770ce14d3d15	725	@param[in] type
Wolfgang Betz	130:770ce14d3d15	726	Type of Address
Wolfgang Betz	130:770ce14d3d15	727
Wolfgang Betz	130:770ce14d3d15	728	@param[in] address[6]
Wolfgang Betz	130:770ce14d3d15	729	Value of the Address to be set
Wolfgang Betz	130:770ce14d3d15	730
Wolfgang Betz	130:770ce14d3d15	731	@returns ble_error_t
Wolfgang Betz	130:770ce14d3d15	732
Wolfgang Betz	130:770ce14d3d15	733	@section EXAMPLE
Wolfgang Betz	130:770ce14d3d15	734
Wolfgang Betz	130:770ce14d3d15	735	@code
Wolfgang Betz	130:770ce14d3d15	736
Wolfgang Betz	130:770ce14d3d15	737	@endcode
Wolfgang Betz	130:770ce14d3d15	738	*/
Wolfgang Betz	130:770ce14d3d15	739	/**************************************************************************/
Andrea Palmieri	239:8e93d6e26c55	740	ble_error_t BlueNRGGap::setAddress(AddressType_t type, const BLEProtocol::AddressBytes_t address)
Wolfgang Betz	130:770ce14d3d15	741	{
Andrea Palmieri	228:25368f053411	742	tBleStatus ret;
Andrea Palmieri	228:25368f053411	743
Andrea Palmieri	210:08c4c85ca679	744	if (type > BLEProtocol::AddressType::RANDOM_PRIVATE_NON_RESOLVABLE) {
Wolfgang Betz	130:770ce14d3d15	745	return BLE_ERROR_PARAM_OUT_OF_RANGE;
Wolfgang Betz	130:770ce14d3d15	746	}
Wolfgang Betz	130:770ce14d3d15	747
Wolfgang Betz	132:51056160fa4a	748	addr_type = type;
Andrea Palmieri	228:25368f053411	749
Andrea Palmieri	228:25368f053411	750	// If Address Type is other than PUBLIC, the given Address is ignored
Andrea Palmieri	228:25368f053411	751	if(addr_type == BLEProtocol::AddressType::PUBLIC){
Andrea Palmieri	228:25368f053411	752	ret = aci_hal_write_config_data(CONFIG_DATA_PUBADDR_OFFSET,
Andrea Palmieri	228:25368f053411	753	CONFIG_DATA_PUBADDR_LEN,
Andrea Palmieri	228:25368f053411	754	address);
Andrea Palmieri	229:9981f62cdb1a	755	if(ret != BLE_STATUS_SUCCESS) {
Andrea Palmieri	239:8e93d6e26c55	756	return BLE_ERROR_OPERATION_NOT_PERMITTED;
Andrea Palmieri	229:9981f62cdb1a	757	}
Andrea Palmieri	239:8e93d6e26c55	758	} else {
Andrea Palmieri	239:8e93d6e26c55	759	return BLE_ERROR_OPERATION_NOT_PERMITTED;
Wolfgang Betz	130:770ce14d3d15	760	}
Wolfgang Betz	130:770ce14d3d15	761
Wolfgang Betz	130:770ce14d3d15	762	return BLE_ERROR_NONE;
Wolfgang Betz	130:770ce14d3d15	763	}
Andrea Palmieri	229:9981f62cdb1a	764
Wolfgang Betz	130:770ce14d3d15	765	/**************************************************************************/
Wolfgang Betz	130:770ce14d3d15	766	/*!
Wolfgang Betz	130:770ce14d3d15	767	@brief Returns boolean if the address of the device has been set
Wolfgang Betz	130:770ce14d3d15	768	or not
Wolfgang Betz	130:770ce14d3d15	769
Wolfgang Betz	130:770ce14d3d15	770	@returns bool
Wolfgang Betz	130:770ce14d3d15	771
Wolfgang Betz	130:770ce14d3d15	772	@section EXAMPLE
Wolfgang Betz	130:770ce14d3d15	773
Wolfgang Betz	130:770ce14d3d15	774	@code
Wolfgang Betz	130:770ce14d3d15	775
Wolfgang Betz	130:770ce14d3d15	776	@endcode
Wolfgang Betz	130:770ce14d3d15	777	*/
Wolfgang Betz	130:770ce14d3d15	778	/**************************************************************************/
Wolfgang Betz	130:770ce14d3d15	779	bool BlueNRGGap::getIsSetAddress()
Wolfgang Betz	130:770ce14d3d15	780	{
Wolfgang Betz	130:770ce14d3d15	781	return isSetAddress;
Wolfgang Betz	130:770ce14d3d15	782	}
Wolfgang Betz	130:770ce14d3d15	783
Wolfgang Betz	130:770ce14d3d15	784	/**************************************************************************/
Wolfgang Betz	130:770ce14d3d15	785	/*!
Wolfgang Betz	130:770ce14d3d15	786	@brief Returns the address of the device if set
Wolfgang Betz	130:770ce14d3d15	787
Wolfgang Betz	130:770ce14d3d15	788	@returns Pointer to the address if Address is set else NULL
Wolfgang Betz	130:770ce14d3d15	789
Wolfgang Betz	130:770ce14d3d15	790	@section EXAMPLE
Wolfgang Betz	130:770ce14d3d15	791
Wolfgang Betz	130:770ce14d3d15	792	@code
Wolfgang Betz	130:770ce14d3d15	793
Wolfgang Betz	130:770ce14d3d15	794	@endcode
Wolfgang Betz	130:770ce14d3d15	795	*/
Wolfgang Betz	130:770ce14d3d15	796	/**************************************************************************/
Wolfgang Betz	130:770ce14d3d15	797	ble_error_t BlueNRGGap::getAddress(AddressType_t *typeP, Address_t address)
Wolfgang Betz	130:770ce14d3d15	798	{
Andrea Palmieri	229:9981f62cdb1a	799	uint8_t bdaddr[BDADDR_SIZE];
Andrea Palmieri	229:9981f62cdb1a	800	uint8_t data_len_out;
Andrea Palmieri	229:9981f62cdb1a	801
Andrea Palmieri	228:25368f053411	802	if(typeP != NULL) {
Andrea Palmieri	228:25368f053411	803	*typeP = addr_type;
Andrea Palmieri	228:25368f053411	804	}
Andrea Palmieri	228:25368f053411	805
Andrea Palmieri	229:9981f62cdb1a	806	tBleStatus ret = aci_hal_read_config_data(CONFIG_DATA_RANDOM_ADDRESS_IDB05A1, BDADDR_SIZE, &data_len_out, bdaddr);
Andrea Palmieri	229:9981f62cdb1a	807	if(ret != BLE_STATUS_SUCCESS) {
Andrea Palmieri	229:9981f62cdb1a	808	return BLE_ERROR_UNSPECIFIED;
Andrea Palmieri	229:9981f62cdb1a	809	}
Andrea Palmieri	229:9981f62cdb1a	810
Andrea Palmieri	228:25368f053411	811	if(address != NULL) {
Andrea Palmieri	228:25368f053411	812	memcpy(address, bdaddr, BDADDR_SIZE);
Wolfgang Betz	130:770ce14d3d15	813	}
Wolfgang Betz	130:770ce14d3d15	814
Wolfgang Betz	130:770ce14d3d15	815	return BLE_ERROR_NONE;
Wolfgang Betz	130:770ce14d3d15	816	}
Wolfgang Betz	130:770ce14d3d15	817
Wolfgang Betz	130:770ce14d3d15	818	/**************************************************************************/
Wolfgang Betz	130:770ce14d3d15	819	/*!
Wolfgang Betz	130:770ce14d3d15	820	@brief obtains preferred connection params
Wolfgang Betz	130:770ce14d3d15	821
Wolfgang Betz	130:770ce14d3d15	822	@returns ble_error_t
Wolfgang Betz	130:770ce14d3d15	823
Wolfgang Betz	130:770ce14d3d15	824	@section EXAMPLE
Wolfgang Betz	130:770ce14d3d15	825
Wolfgang Betz	130:770ce14d3d15	826	@code
Wolfgang Betz	130:770ce14d3d15	827
Wolfgang Betz	130:770ce14d3d15	828	@endcode
Wolfgang Betz	130:770ce14d3d15	829	*/
Wolfgang Betz	130:770ce14d3d15	830	/**************************************************************************/
Wolfgang Betz	130:770ce14d3d15	831	ble_error_t BlueNRGGap::getPreferredConnectionParams(ConnectionParams_t *params)
Wolfgang Betz	130:770ce14d3d15	832	{
Andrea Palmieri	142:adf1567d3900	833	/* avoid compiler warnings about unused variables */
Andrea Palmieri	142:adf1567d3900	834	(void)params;
Andrea Palmieri	142:adf1567d3900	835
Andrea Palmieri	240:f487d8c86ce4	836	return BLE_ERROR_NOT_IMPLEMENTED;
Wolfgang Betz	130:770ce14d3d15	837	}
Wolfgang Betz	130:770ce14d3d15	838
Wolfgang Betz	130:770ce14d3d15	839
Wolfgang Betz	130:770ce14d3d15	840	/**************************************************************************/
Wolfgang Betz	130:770ce14d3d15	841	/*!
Wolfgang Betz	130:770ce14d3d15	842	@brief sets preferred connection params
Wolfgang Betz	130:770ce14d3d15	843
Wolfgang Betz	130:770ce14d3d15	844	@returns ble_error_t
Wolfgang Betz	130:770ce14d3d15	845
Wolfgang Betz	130:770ce14d3d15	846	@section EXAMPLE
Wolfgang Betz	130:770ce14d3d15	847
Wolfgang Betz	130:770ce14d3d15	848	@code
Wolfgang Betz	130:770ce14d3d15	849
Wolfgang Betz	130:770ce14d3d15	850	@endcode
Wolfgang Betz	130:770ce14d3d15	851	*/
Wolfgang Betz	130:770ce14d3d15	852	/**************************************************************************/
Wolfgang Betz	130:770ce14d3d15	853	ble_error_t BlueNRGGap::setPreferredConnectionParams(const ConnectionParams_t *params)
Wolfgang Betz	130:770ce14d3d15	854	{
Andrea Palmieri	142:adf1567d3900	855	/* avoid compiler warnings about unused variables */
Andrea Palmieri	142:adf1567d3900	856	(void)params;
Andrea Palmieri	142:adf1567d3900	857
Andrea Palmieri	240:f487d8c86ce4	858	return BLE_ERROR_NOT_IMPLEMENTED;
Wolfgang Betz	130:770ce14d3d15	859	}
Wolfgang Betz	130:770ce14d3d15	860
Wolfgang Betz	130:770ce14d3d15	861	/**************************************************************************/
Wolfgang Betz	130:770ce14d3d15	862	/*!
Wolfgang Betz	130:770ce14d3d15	863	@brief updates preferred connection params
Wolfgang Betz	130:770ce14d3d15	864
Wolfgang Betz	130:770ce14d3d15	865	@returns ble_error_t
Wolfgang Betz	130:770ce14d3d15	866
Wolfgang Betz	130:770ce14d3d15	867	@section EXAMPLE
Wolfgang Betz	130:770ce14d3d15	868
Wolfgang Betz	130:770ce14d3d15	869	@code
Wolfgang Betz	130:770ce14d3d15	870
Wolfgang Betz	130:770ce14d3d15	871	@endcode
Wolfgang Betz	130:770ce14d3d15	872	*/
Wolfgang Betz	130:770ce14d3d15	873	/**************************************************************************/
Wolfgang Betz	130:770ce14d3d15	874	ble_error_t BlueNRGGap::updateConnectionParams(Handle_t handle, const ConnectionParams_t *params)
Wolfgang Betz	130:770ce14d3d15	875	{
Andrea Palmieri	142:adf1567d3900	876	/* avoid compiler warnings about unused variables */
Andrea Palmieri	142:adf1567d3900	877	(void) handle;
Andrea Palmieri	142:adf1567d3900	878	(void)params;
Andrea Palmieri	142:adf1567d3900	879
Wolfgang Betz	130:770ce14d3d15	880	return BLE_ERROR_NONE;
Wolfgang Betz	130:770ce14d3d15	881	}
Wolfgang Betz	130:770ce14d3d15	882
Wolfgang Betz	130:770ce14d3d15	883	/**************************************************************************/
Wolfgang Betz	130:770ce14d3d15	884	/*!
Wolfgang Betz	130:770ce14d3d15	885	@brief Sets the Device Name Characteristic
Wolfgang Betz	130:770ce14d3d15	886
Wolfgang Betz	130:770ce14d3d15	887	@param[in] deviceName
Wolfgang Betz	130:770ce14d3d15	888	pointer to device name to be set
Wolfgang Betz	130:770ce14d3d15	889
Wolfgang Betz	130:770ce14d3d15	890	@returns ble_error_t
Wolfgang Betz	130:770ce14d3d15	891
Wolfgang Betz	130:770ce14d3d15	892	@retval BLE_ERROR_NONE
Wolfgang Betz	130:770ce14d3d15	893	Everything executed properly
Wolfgang Betz	130:770ce14d3d15	894
Wolfgang Betz	130:770ce14d3d15	895	@section EXAMPLE
Wolfgang Betz	130:770ce14d3d15	896
Wolfgang Betz	130:770ce14d3d15	897	@code
Wolfgang Betz	130:770ce14d3d15	898
Wolfgang Betz	130:770ce14d3d15	899	@endcode
Wolfgang Betz	130:770ce14d3d15	900	*/
Wolfgang Betz	130:770ce14d3d15	901	/**************************************************************************/
Wolfgang Betz	130:770ce14d3d15	902	ble_error_t BlueNRGGap::setDeviceName(const uint8_t *deviceName)
Wolfgang Betz	130:770ce14d3d15	903	{
Andrea Palmieri	187:2e517d3ddd71	904	tBleStatus ret;
Wolfgang Betz	130:770ce14d3d15	905	uint8_t nameLen = 0;
Wolfgang Betz	130:770ce14d3d15	906
Andrea Palmieri	228:25368f053411	907	nameLen = strlen((const char*)deviceName);
Andrea Palmieri	228:25368f053411	908	PRINTF("DeviceName Size=%d\n\r", nameLen);
Andrea Palmieri	228:25368f053411	909
Andrea Palmieri	222:37a7e289ee3d	910	ret = aci_gatt_update_char_value(g_gap_service_handle,
Andrea Palmieri	222:37a7e289ee3d	911	g_device_name_char_handle,
Andrea Palmieri	222:37a7e289ee3d	912	0,
Andrea Palmieri	222:37a7e289ee3d	913	nameLen,
Andrea Palmieri	228:25368f053411	914	deviceName);
Andrea Palmieri	187:2e517d3ddd71	915
Andrea Palmieri	187:2e517d3ddd71	916	if (BLE_STATUS_SUCCESS != ret){
Andrea Palmieri	187:2e517d3ddd71	917	PRINTF("device set name failed (ret=0x%x)!!\n\r", ret) ;
Andrea Palmieri	187:2e517d3ddd71	918	switch (ret) {
Andrea Palmieri	187:2e517d3ddd71	919	case BLE_STATUS_INVALID_HANDLE:
Andrea Palmieri	187:2e517d3ddd71	920	case BLE_STATUS_INVALID_PARAMETER:
Andrea Palmieri	187:2e517d3ddd71	921	return BLE_ERROR_INVALID_PARAM;
Andrea Palmieri	187:2e517d3ddd71	922	case BLE_STATUS_INSUFFICIENT_RESOURCES:
Andrea Palmieri	187:2e517d3ddd71	923	return BLE_ERROR_NO_MEM;
Andrea Palmieri	187:2e517d3ddd71	924	case BLE_STATUS_TIMEOUT:
Andrea Palmieri	187:2e517d3ddd71	925	return BLE_STACK_BUSY;
Andrea Palmieri	187:2e517d3ddd71	926	default:
Andrea Palmieri	187:2e517d3ddd71	927	return BLE_ERROR_UNSPECIFIED;
Andrea Palmieri	187:2e517d3ddd71	928	}
Wolfgang Betz	130:770ce14d3d15	929	}
Wolfgang Betz	130:770ce14d3d15	930
Wolfgang Betz	130:770ce14d3d15	931	return BLE_ERROR_NONE;
Wolfgang Betz	130:770ce14d3d15	932	}
Wolfgang Betz	130:770ce14d3d15	933
Wolfgang Betz	130:770ce14d3d15	934	/**************************************************************************/
Wolfgang Betz	130:770ce14d3d15	935	/*!
Wolfgang Betz	130:770ce14d3d15	936	@brief Gets the Device Name Characteristic
Wolfgang Betz	130:770ce14d3d15	937
Wolfgang Betz	130:770ce14d3d15	938	@param[in] deviceName
Wolfgang Betz	130:770ce14d3d15	939	pointer to device name
Wolfgang Betz	130:770ce14d3d15	940
Wolfgang Betz	130:770ce14d3d15	941	@param[in] lengthP
Wolfgang Betz	130:770ce14d3d15	942	pointer to device name length
Wolfgang Betz	130:770ce14d3d15	943
Wolfgang Betz	130:770ce14d3d15	944	@returns ble_error_t
Wolfgang Betz	130:770ce14d3d15	945
Wolfgang Betz	130:770ce14d3d15	946	@retval BLE_ERROR_NONE
Wolfgang Betz	130:770ce14d3d15	947	Everything executed properly
Wolfgang Betz	130:770ce14d3d15	948
Wolfgang Betz	130:770ce14d3d15	949	@section EXAMPLE
Wolfgang Betz	130:770ce14d3d15	950
Wolfgang Betz	130:770ce14d3d15	951	@code
Wolfgang Betz	130:770ce14d3d15	952
Wolfgang Betz	130:770ce14d3d15	953	@endcode
Wolfgang Betz	130:770ce14d3d15	954	*/
Wolfgang Betz	130:770ce14d3d15	955	/**************************************************************************/
Andrea Palmieri	228:25368f053411	956	ble_error_t BlueNRGGap::getDeviceName(uint8_t deviceName, unsigned lengthP)
Andrea Palmieri	228:25368f053411	957	{
Andrea Palmieri	228:25368f053411	958	tBleStatus ret;
Andrea Palmieri	228:25368f053411	959
Andrea Palmieri	229:9981f62cdb1a	960	ret = aci_gatt_read_handle_value(g_device_name_char_handle+BlueNRGGattServer::CHAR_VALUE_HANDLE,
Andrea Palmieri	228:25368f053411	961	*lengthP,
Andrea Palmieri	228:25368f053411	962	(uint16_t *)lengthP,
Andrea Palmieri	228:25368f053411	963	deviceName);
Andrea Palmieri	228:25368f053411	964	PRINTF("getDeviceName ret=0x%02x (lengthP=%d)\n\r", ret, *lengthP);
Andrea Palmieri	228:25368f053411	965	if (ret == BLE_STATUS_SUCCESS) {
Andrea Palmieri	228:25368f053411	966	return BLE_ERROR_NONE;
Andrea Palmieri	228:25368f053411	967	} else {
Andrea Palmieri	228:25368f053411	968	return BLE_ERROR_PARAM_OUT_OF_RANGE;
Andrea Palmieri	228:25368f053411	969	}
Wolfgang Betz	130:770ce14d3d15	970	}
Wolfgang Betz	130:770ce14d3d15	971
Wolfgang Betz	130:770ce14d3d15	972	/**************************************************************************/
Wolfgang Betz	130:770ce14d3d15	973	/*!
Wolfgang Betz	130:770ce14d3d15	974	@brief Sets the Device Appearance Characteristic
Wolfgang Betz	130:770ce14d3d15	975
Wolfgang Betz	130:770ce14d3d15	976	@param[in] appearance
Wolfgang Betz	130:770ce14d3d15	977	device appearance
Wolfgang Betz	130:770ce14d3d15	978
Wolfgang Betz	130:770ce14d3d15	979	@returns ble_error_t
Wolfgang Betz	130:770ce14d3d15	980
Wolfgang Betz	130:770ce14d3d15	981	@retval BLE_ERROR_NONE
Wolfgang Betz	130:770ce14d3d15	982	Everything executed properly
Wolfgang Betz	130:770ce14d3d15	983
Wolfgang Betz	130:770ce14d3d15	984	@section EXAMPLE
Wolfgang Betz	130:770ce14d3d15	985
Wolfgang Betz	130:770ce14d3d15	986	@code
Wolfgang Betz	130:770ce14d3d15	987
Wolfgang Betz	130:770ce14d3d15	988	@endcode
Wolfgang Betz	130:770ce14d3d15	989	*/
Wolfgang Betz	130:770ce14d3d15	990	/**************************************************************************/
Wolfgang Betz	130:770ce14d3d15	991	ble_error_t BlueNRGGap::setAppearance(GapAdvertisingData::Appearance appearance)
Wolfgang Betz	130:770ce14d3d15	992	{
Andrea Palmieri	187:2e517d3ddd71	993	tBleStatus ret;
Andrea Palmieri	228:25368f053411	994	uint8_t deviceAppearance[2];
Andrea Palmieri	187:2e517d3ddd71	995
Wolfgang Betz	130:770ce14d3d15	996	STORE_LE_16(deviceAppearance, appearance);
Wolfgang Betz	132:51056160fa4a	997	PRINTF("input: incoming = %d deviceAppearance= 0x%x 0x%x\n\r", appearance, deviceAppearance[1], deviceAppearance[0]);
Wolfgang Betz	130:770ce14d3d15	998
Andrea Palmieri	228:25368f053411	999	ret = aci_gatt_update_char_value(g_gap_service_handle,
Andrea Palmieri	228:25368f053411	1000	g_appearance_char_handle,
Andrea Palmieri	228:25368f053411	1001	0, 2, (uint8_t *)deviceAppearance);
Andrea Palmieri	187:2e517d3ddd71	1002	if (BLE_STATUS_SUCCESS == ret){
Andrea Palmieri	187:2e517d3ddd71	1003	return BLE_ERROR_NONE;
Andrea Palmieri	187:2e517d3ddd71	1004	}
Andrea Palmieri	187:2e517d3ddd71	1005
Andrea Palmieri	217:23870c55b07e	1006	PRINTF("setAppearance failed (ret=0x%x)!!\n\r", ret);
Andrea Palmieri	187:2e517d3ddd71	1007	switch (ret) {
Andrea Palmieri	187:2e517d3ddd71	1008	case BLE_STATUS_INVALID_HANDLE:
Andrea Palmieri	187:2e517d3ddd71	1009	case BLE_STATUS_INVALID_PARAMETER:
Andrea Palmieri	187:2e517d3ddd71	1010	return BLE_ERROR_INVALID_PARAM;
Andrea Palmieri	187:2e517d3ddd71	1011	case BLE_STATUS_INSUFFICIENT_RESOURCES:
Andrea Palmieri	187:2e517d3ddd71	1012	return BLE_ERROR_NO_MEM;
Andrea Palmieri	187:2e517d3ddd71	1013	case BLE_STATUS_TIMEOUT:
Andrea Palmieri	187:2e517d3ddd71	1014	return BLE_STACK_BUSY;
Andrea Palmieri	187:2e517d3ddd71	1015	default:
Andrea Palmieri	187:2e517d3ddd71	1016	return BLE_ERROR_UNSPECIFIED;
Andrea Palmieri	187:2e517d3ddd71	1017	}
Wolfgang Betz	130:770ce14d3d15	1018	}
Wolfgang Betz	130:770ce14d3d15	1019
Wolfgang Betz	130:770ce14d3d15	1020	/**************************************************************************/
Wolfgang Betz	130:770ce14d3d15	1021	/*!
Wolfgang Betz	130:770ce14d3d15	1022	@brief Gets the Device Appearance Characteristic
Wolfgang Betz	130:770ce14d3d15	1023
Wolfgang Betz	130:770ce14d3d15	1024	@param[in] appearance
Wolfgang Betz	130:770ce14d3d15	1025	pointer to device appearance value
Wolfgang Betz	130:770ce14d3d15	1026
Wolfgang Betz	130:770ce14d3d15	1027	@returns ble_error_t
Wolfgang Betz	130:770ce14d3d15	1028
Wolfgang Betz	130:770ce14d3d15	1029	@retval BLE_ERROR_NONE
Wolfgang Betz	130:770ce14d3d15	1030	Everything executed properly
Wolfgang Betz	130:770ce14d3d15	1031
Wolfgang Betz	130:770ce14d3d15	1032	@section EXAMPLE
Wolfgang Betz	130:770ce14d3d15	1033
Wolfgang Betz	130:770ce14d3d15	1034	@code
Wolfgang Betz	130:770ce14d3d15	1035
Wolfgang Betz	130:770ce14d3d15	1036	@endcode
Wolfgang Betz	130:770ce14d3d15	1037	*/
Wolfgang Betz	130:770ce14d3d15	1038	/**************************************************************************/
Wolfgang Betz	130:770ce14d3d15	1039	ble_error_t BlueNRGGap::getAppearance(GapAdvertisingData::Appearance *appearanceP)
Wolfgang Betz	130:770ce14d3d15	1040	{
Andrea Palmieri	228:25368f053411	1041	tBleStatus ret;
Andrea Palmieri	228:25368f053411	1042	uint16_t lengthP = 2;
Andrea Palmieri	228:25368f053411	1043
Andrea Palmieri	229:9981f62cdb1a	1044	ret = aci_gatt_read_handle_value(g_appearance_char_handle+BlueNRGGattServer::CHAR_VALUE_HANDLE,
Andrea Palmieri	228:25368f053411	1045	lengthP,
Andrea Palmieri	228:25368f053411	1046	&lengthP,
Andrea Palmieri	228:25368f053411	1047	(uint8_t*)appearanceP);
Andrea Palmieri	228:25368f053411	1048	PRINTF("getAppearance ret=0x%02x (lengthP=%d)\n\r", ret, lengthP);
Andrea Palmieri	228:25368f053411	1049	if (ret == BLE_STATUS_SUCCESS) {
Andrea Palmieri	228:25368f053411	1050	return BLE_ERROR_NONE;
Andrea Palmieri	228:25368f053411	1051	} else {
Andrea Palmieri	228:25368f053411	1052	return BLE_ERROR_PARAM_OUT_OF_RANGE;
Andrea Palmieri	228:25368f053411	1053	}
Andrea Palmieri	228:25368f053411	1054
Wolfgang Betz	130:770ce14d3d15	1055	}
Wolfgang Betz	130:770ce14d3d15	1056
Andrea Palmieri	160:174387d53809	1057	GapScanningParams* BlueNRGGap::getScanningParams(void)
Andrea Palmieri	160:174387d53809	1058	{
Andrea Palmieri	160:174387d53809	1059	return &_scanningParams;
Andrea Palmieri	160:174387d53809	1060	}
Andrea Palmieri	160:174387d53809	1061
Wolfgang Betz	165:3576598c0889	1062	static void makeConnection(void)
Wolfgang Betz	162:667f97a4db7f	1063	{
Wolfgang Betz	165:3576598c0889	1064	BlueNRGGap::getInstance().createConnection();
Wolfgang Betz	162:667f97a4db7f	1065	}
Wolfgang Betz	162:667f97a4db7f	1066
Wolfgang Betz	132:51056160fa4a	1067	void BlueNRGGap::Discovery_CB(Reason_t reason,
Wolfgang Betz	132:51056160fa4a	1068	uint8_t adv_type,
Andrea Palmieri	229:9981f62cdb1a	1069	uint8_t addr_type,
Wolfgang Betz	132:51056160fa4a	1070	uint8_t *addr,
Wolfgang Betz	132:51056160fa4a	1071	uint8_t *data_length,
Wolfgang Betz	132:51056160fa4a	1072	uint8_t *data,
Wolfgang Betz	132:51056160fa4a	1073	uint8_t *RSSI)
Wolfgang Betz	132:51056160fa4a	1074	{
Wolfgang Betz	132:51056160fa4a	1075	switch (reason) {
Wolfgang Betz	132:51056160fa4a	1076	case DEVICE_FOUND:
Wolfgang Betz	132:51056160fa4a	1077	{
Wolfgang Betz	132:51056160fa4a	1078	GapAdvertisingParams::AdvertisingType_t type;
Wolfgang Betz	132:51056160fa4a	1079	bool isScanResponse = false;
Andrea Palmieri	229:9981f62cdb1a	1080
Andrea Palmieri	229:9981f62cdb1a	1081	/*
Andrea Palmieri	229:9981f62cdb1a	1082	* Whitelisting (scan policy):
Andrea Palmieri	229:9981f62cdb1a	1083	* SCAN_POLICY_FILTER_ALL_ADV (ADV packets only from devs in the White List) &&
Andrea Palmieri	229:9981f62cdb1a	1084	* Private Random Address
Andrea Palmieri	229:9981f62cdb1a	1085	* => scan_results = FALSE
Andrea Palmieri	229:9981f62cdb1a	1086	* FIXME: the Security Manager should be implemented
Andrea Palmieri	229:9981f62cdb1a	1087	*/
Andrea Palmieri	229:9981f62cdb1a	1088	ScanningPolicyMode_t mode = getScanningPolicyMode();
Andrea Palmieri	229:9981f62cdb1a	1089	PRINTF("mode=%u addr_type=%u\n\r", mode, addr_type);
Andrea Palmieri	229:9981f62cdb1a	1090	if(mode == Gap::SCAN_POLICY_FILTER_ALL_ADV \|\|
Andrea Palmieri	229:9981f62cdb1a	1091	(addr_type == RESOLVABLE_PRIVATE_ADDR \|\|
Andrea Palmieri	229:9981f62cdb1a	1092	addr_type == NON_RESOLVABLE_PRIVATE_ADDR)) {
Andrea Palmieri	229:9981f62cdb1a	1093	return;
Andrea Palmieri	229:9981f62cdb1a	1094	}
Andrea Palmieri	229:9981f62cdb1a	1095
Wolfgang Betz	132:51056160fa4a	1096	switch(adv_type) {
Wolfgang Betz	132:51056160fa4a	1097	case ADV_IND:
Wolfgang Betz	132:51056160fa4a	1098	type = GapAdvertisingParams::ADV_CONNECTABLE_UNDIRECTED;
Wolfgang Betz	132:51056160fa4a	1099	break;
Wolfgang Betz	132:51056160fa4a	1100	case ADV_DIRECT_IND:
Wolfgang Betz	132:51056160fa4a	1101	type = GapAdvertisingParams::ADV_CONNECTABLE_DIRECTED;
Wolfgang Betz	132:51056160fa4a	1102	break;
Wolfgang Betz	132:51056160fa4a	1103	case ADV_SCAN_IND:
Wolfgang Betz	132:51056160fa4a	1104	case SCAN_RSP:
Wolfgang Betz	132:51056160fa4a	1105	type = GapAdvertisingParams::ADV_SCANNABLE_UNDIRECTED;
Wolfgang Betz	132:51056160fa4a	1106	isScanResponse = true;
Wolfgang Betz	132:51056160fa4a	1107	break;
Wolfgang Betz	132:51056160fa4a	1108	case ADV_NONCONN_IND:
Wolfgang Betz	132:51056160fa4a	1109	type = GapAdvertisingParams::ADV_NON_CONNECTABLE_UNDIRECTED;
Andrea Palmieri	142:adf1567d3900	1110	break;
Andrea Palmieri	142:adf1567d3900	1111	default:
Andrea Palmieri	142:adf1567d3900	1112	type = GapAdvertisingParams::ADV_CONNECTABLE_UNDIRECTED;
Wolfgang Betz	132:51056160fa4a	1113	}
Wolfgang Betz	132:51056160fa4a	1114
Andrea Palmieri	217:23870c55b07e	1115	PRINTF("data_length=%d adv peerAddr[%02x %02x %02x %02x %02x %02x] \r\n",
Andrea Palmieri	217:23870c55b07e	1116	*data_length, addr[5], addr[4], addr[3], addr[2], addr[1], addr[0]);
Andrea Palmieri	238:b6454c839f42	1117	if(!_connecting) {
Andrea Palmieri	238:b6454c839f42	1118	processAdvertisementReport(addr, RSSI, isScanResponse, type, data_length, data);
Andrea Palmieri	238:b6454c839f42	1119	}
Andrea Palmieri	160:174387d53809	1120	PRINTF("!!!After processAdvertisementReport\n\r");
Wolfgang Betz	132:51056160fa4a	1121	}
Wolfgang Betz	132:51056160fa4a	1122	break;
Wolfgang Betz	132:51056160fa4a	1123
Wolfgang Betz	132:51056160fa4a	1124	case DISCOVERY_COMPLETE:
Wolfgang Betz	132:51056160fa4a	1125	// The discovery is complete. If this is due to a stop scanning (i.e., the device
Wolfgang Betz	132:51056160fa4a	1126	// we are interested in has been found) and a connection has been requested
Andrea Palmieri	229:9981f62cdb1a	1127	// then we start the device connection.
Andrea Palmieri	145:024a552e4715	1128	PRINTF("DISCOVERY_COMPLETE\n\r");
Wolfgang Betz	132:51056160fa4a	1129	_scanning = false;
Wolfgang Betz	132:51056160fa4a	1130
Wolfgang Betz	165:3576598c0889	1131	// Since the DISCOVERY_COMPLETE event can be received during the scanning interval,
Andrea Palmieri	229:9981f62cdb1a	1132	// we need to delay the starting of connection
Wolfgang Betz	165:3576598c0889	1133	uint16_t delay = 2*(_scanningParams.getInterval());
Wolfgang Betz	165:3576598c0889	1134
Andrea Palmieri	217:23870c55b07e	1135	#ifdef AST_FOR_MBED_OS
Wolfgang Betz	162:667f97a4db7f	1136	if(_connecting) {
Wolfgang Betz	165:3576598c0889	1137	minar::Scheduler::postCallback(makeConnection).delay(minar::milliseconds(delay));
Wolfgang Betz	132:51056160fa4a	1138	}
Andrea Palmieri	217:23870c55b07e	1139	#else
Andrea Palmieri	217:23870c55b07e	1140	Clock_Wait(delay);
Andrea Palmieri	217:23870c55b07e	1141	if(_connecting) {
Andrea Palmieri	217:23870c55b07e	1142	makeConnection();
Andrea Palmieri	217:23870c55b07e	1143	}
Andrea Palmieri	217:23870c55b07e	1144	#endif /* AST_FOR_MBED_OS */
Wolfgang Betz	132:51056160fa4a	1145
Wolfgang Betz	132:51056160fa4a	1146	break;
Wolfgang Betz	132:51056160fa4a	1147	}
Wolfgang Betz	132:51056160fa4a	1148	}
Wolfgang Betz	132:51056160fa4a	1149
Wolfgang Betz	132:51056160fa4a	1150	ble_error_t BlueNRGGap::startRadioScan(const GapScanningParams &scanningParams)
Wolfgang Betz	132:51056160fa4a	1151	{
Wolfgang Betz	132:51056160fa4a	1152
Wolfgang Betz	165:3576598c0889	1153	tBleStatus ret = BLE_STATUS_SUCCESS;
Andrea Palmieri	222:37a7e289ee3d	1154
Andrea Palmieri	222:37a7e289ee3d	1155	// Stop ADV before scanning
Andrea Palmieri	223:36df860f7ffc	1156	/*
Andrea Palmieri	222:37a7e289ee3d	1157	if (state.advertising == 1) {
Andrea Palmieri	222:37a7e289ee3d	1158	stopAdvertising();
Andrea Palmieri	222:37a7e289ee3d	1159	}
Andrea Palmieri	223:36df860f7ffc	1160	*/
Andrea Palmieri	222:37a7e289ee3d	1161
Andrea Palmieri	229:9981f62cdb1a	1162	/*
Andrea Palmieri	229:9981f62cdb1a	1163	* Whitelisting (scan policy):
Andrea Palmieri	229:9981f62cdb1a	1164	* SCAN_POLICY_FILTER_ALL_ADV (ADV packets only from devs in the White List) &&
Andrea Palmieri	229:9981f62cdb1a	1165	* White List is empty
Andrea Palmieri	229:9981f62cdb1a	1166	* => scan operation = FAILURE
Andrea Palmieri	229:9981f62cdb1a	1167	* FIXME: the Security Manager should be implemented
Andrea Palmieri	229:9981f62cdb1a	1168	*/
Andrea Palmieri	229:9981f62cdb1a	1169	ScanningPolicyMode_t mode = getScanningPolicyMode();
Andrea Palmieri	229:9981f62cdb1a	1170	uint8_t whiteListSize = whitelistAddresses.size;
Andrea Palmieri	229:9981f62cdb1a	1171	if(whiteListSize == 0 && mode == Gap::SCAN_POLICY_FILTER_ALL_ADV) {
Andrea Palmieri	229:9981f62cdb1a	1172	return BLE_ERROR_OPERATION_NOT_PERMITTED;
Andrea Palmieri	229:9981f62cdb1a	1173	}
Andrea Palmieri	229:9981f62cdb1a	1174
Andrea Palmieri	217:23870c55b07e	1175	ret = btleStartRadioScan(scanningParams.getActiveScanning(),
Andrea Palmieri	217:23870c55b07e	1176	scanningParams.getInterval(),
Andrea Palmieri	217:23870c55b07e	1177	scanningParams.getWindow(),
Andrea Palmieri	217:23870c55b07e	1178	addr_type);
Andrea Palmieri	217:23870c55b07e	1179
Andrea Palmieri	229:9981f62cdb1a	1180	PRINTF("Scanning...\n\r");
Andrea Palmieri	229:9981f62cdb1a	1181	PRINTF("scanningParams.getInterval()=%u[msec]\r\n",(scanningParams.getInterval()*625)/1000);
Andrea Palmieri	229:9981f62cdb1a	1182	PRINTF("scanningParams.getWindow()=%u[msec]\r\n",(scanningParams.getWindow()*625)/1000);
Andrea Palmieri	229:9981f62cdb1a	1183	//PRINTF("_advParams.getInterval()=%u\r\n",_advParams.getInterval());
Andrea Palmieri	229:9981f62cdb1a	1184	//PRINTF("CONN_P1=%u\r\n",(unsigned)CONN_P1);
Andrea Palmieri	229:9981f62cdb1a	1185	//PRINTF("CONN_P2=%u\r\n",(unsigned)CONN_P2);
Andrea Palmieri	217:23870c55b07e	1186	if (BLE_STATUS_SUCCESS == ret){
Andrea Palmieri	217:23870c55b07e	1187	PRINTF("Observation Procedure Started\n");
Andrea Palmieri	217:23870c55b07e	1188	_scanning = true;
Andrea Palmieri	217:23870c55b07e	1189	return BLE_ERROR_NONE;
Andrea Palmieri	145:024a552e4715	1190	}
Andrea Palmieri	217:23870c55b07e	1191
Andrea Palmieri	217:23870c55b07e	1192	// Observer role is not supported by X-NUCLEO-IDB04A1, return BLE_ERROR_NOT_IMPLEMENTED
Andrea Palmieri	217:23870c55b07e	1193	switch (ret) {
Andrea Palmieri	217:23870c55b07e	1194	case BLE_STATUS_INVALID_CID:
Andrea Palmieri	229:9981f62cdb1a	1195	PRINTF("Observation Procedure not implemented!!!\n\r");
Andrea Palmieri	217:23870c55b07e	1196	return BLE_ERROR_NOT_IMPLEMENTED;
Andrea Palmieri	217:23870c55b07e	1197	default:
Andrea Palmieri	229:9981f62cdb1a	1198	PRINTF("Observation Procedure failed (0x%02X)\n\r", ret);
Andrea Palmieri	217:23870c55b07e	1199	return BLE_ERROR_UNSPECIFIED;
Wolfgang Betz	132:51056160fa4a	1200	}
Andrea Palmieri	217:23870c55b07e	1201
Wolfgang Betz	130:770ce14d3d15	1202	}
Wolfgang Betz	130:770ce14d3d15	1203
Wolfgang Betz	130:770ce14d3d15	1204	ble_error_t BlueNRGGap::stopScan() {
Wolfgang Betz	165:3576598c0889	1205	tBleStatus ret = BLE_STATUS_SUCCESS;
Andrea Palmieri	229:9981f62cdb1a	1206
Andrea Palmieri	229:9981f62cdb1a	1207	PRINTF("stopScan\n\r");
Andrea Palmieri	217:23870c55b07e	1208	ret = aci_gap_terminate_gap_procedure(GAP_OBSERVATION_PROC);
Wolfgang Betz	132:51056160fa4a	1209
Wolfgang Betz	132:51056160fa4a	1210	if (ret != BLE_STATUS_SUCCESS) {
Andrea Palmieri	238:b6454c839f42	1211	PRINTF("GAP Terminate Gap Procedure failed(ret=0x%x)\n", ret);
Wolfgang Betz	132:51056160fa4a	1212	return BLE_ERROR_UNSPECIFIED;
Wolfgang Betz	132:51056160fa4a	1213	} else {
Wolfgang Betz	132:51056160fa4a	1214	PRINTF("Discovery Procedure Terminated\n");
Wolfgang Betz	130:770ce14d3d15	1215	return BLE_ERROR_NONE;
Wolfgang Betz	132:51056160fa4a	1216	}
Wolfgang Betz	130:770ce14d3d15	1217	}
Wolfgang Betz	130:770ce14d3d15	1218
Wolfgang Betz	130:770ce14d3d15	1219	/**************************************************************************/
Wolfgang Betz	130:770ce14d3d15	1220	/*!
Wolfgang Betz	130:770ce14d3d15	1221	@brief set Tx power level
Wolfgang Betz	130:770ce14d3d15	1222	@param[in] txPower Transmission Power level
Wolfgang Betz	130:770ce14d3d15	1223	@returns ble_error_t
Wolfgang Betz	130:770ce14d3d15	1224	*/
Wolfgang Betz	130:770ce14d3d15	1225	/**************************************************************************/
Wolfgang Betz	130:770ce14d3d15	1226	ble_error_t BlueNRGGap::setTxPower(int8_t txPower)
Wolfgang Betz	130:770ce14d3d15	1227	{
Wolfgang Betz	130:770ce14d3d15	1228	tBleStatus ret;
Wolfgang Betz	130:770ce14d3d15	1229
Wolfgang Betz	130:770ce14d3d15	1230	int8_t enHighPower = 0;
Andrea Palmieri	201:a9bc2e8b01d7	1231	int8_t paLevel = 0;
Andrea Palmieri	201:a9bc2e8b01d7	1232
Andrea Palmieri	228:25368f053411	1233	ret = getHighPowerAndPALevelValue(txPower, enHighPower, paLevel);
Andrea Palmieri	228:25368f053411	1234	if(ret!=BLE_STATUS_SUCCESS) {
Andrea Palmieri	228:25368f053411	1235	return BLE_ERROR_PARAM_OUT_OF_RANGE;
Andrea Palmieri	228:25368f053411	1236	}
Andrea Palmieri	201:a9bc2e8b01d7	1237
Wolfgang Betz	132:51056160fa4a	1238	PRINTF("enHighPower=%d, paLevel=%d\n\r", enHighPower, paLevel);
Wolfgang Betz	130:770ce14d3d15	1239	ret = aci_hal_set_tx_power_level(enHighPower, paLevel);
Wolfgang Betz	130:770ce14d3d15	1240	if(ret!=BLE_STATUS_SUCCESS) {
Andrea Palmieri	228:25368f053411	1241	return BLE_ERROR_PARAM_OUT_OF_RANGE;
Wolfgang Betz	130:770ce14d3d15	1242	}
Andrea Palmieri	201:a9bc2e8b01d7	1243
Wolfgang Betz	130:770ce14d3d15	1244	return BLE_ERROR_NONE;
Wolfgang Betz	130:770ce14d3d15	1245	}
Wolfgang Betz	130:770ce14d3d15	1246
Wolfgang Betz	130:770ce14d3d15	1247	/**************************************************************************/
Wolfgang Betz	130:770ce14d3d15	1248	/*!
Wolfgang Betz	130:770ce14d3d15	1249	@brief get permitted Tx power values
Wolfgang Betz	130:770ce14d3d15	1250	@param[in] values pointer to pointer to permitted power values
Wolfgang Betz	130:770ce14d3d15	1251	@param[in] num number of values
Wolfgang Betz	130:770ce14d3d15	1252	*/
Wolfgang Betz	130:770ce14d3d15	1253	/**************************************************************************/
Wolfgang Betz	130:770ce14d3d15	1254	void BlueNRGGap::getPermittedTxPowerValues(const int8_t *valueArrayPP, size_t countP) {
Wolfgang Betz	130:770ce14d3d15	1255	static const int8_t permittedTxValues[] = {
Andrea Palmieri	229:9981f62cdb1a	1256	-18, -15, -14, -12, -11, -9, -8, -6, -5, -2, 0, 2, 4, 5, 8
Wolfgang Betz	130:770ce14d3d15	1257	};
Wolfgang Betz	130:770ce14d3d15	1258
Wolfgang Betz	130:770ce14d3d15	1259	*valueArrayPP = permittedTxValues;
Wolfgang Betz	130:770ce14d3d15	1260	*countP = sizeof(permittedTxValues) / sizeof(int8_t);
Wolfgang Betz	130:770ce14d3d15	1261	}
Wolfgang Betz	132:51056160fa4a	1262
Andrea Palmieri	229:9981f62cdb1a	1263	/**************************************************************************/
Andrea Palmieri	229:9981f62cdb1a	1264	/*!
Andrea Palmieri	232:aead10288880	1265	@brief Set advertising parameters according to the current state
Andrea Palmieri	232:aead10288880	1266	Parameters value is set taking into account guidelines of the BlueNRG
Andrea Palmieri	232:aead10288880	1267	time slots allocation
Andrea Palmieri	232:aead10288880	1268	*/
Andrea Palmieri	232:aead10288880	1269	/**************************************************************************/
Andrea Palmieri	232:aead10288880	1270	void BlueNRGGap::setAdvParameters(void)
Andrea Palmieri	232:aead10288880	1271	{
Andrea Palmieri	232:aead10288880	1272	uint32_t advIntMS;
Andrea Palmieri	232:aead10288880	1273
Andrea Palmieri	232:aead10288880	1274	if(state.connected == 1) {
Andrea Palmieri	232:aead10288880	1275	advIntMS = (conn_min_interval*1.25)-GUARD_INT;
Andrea Palmieri	232:aead10288880	1276	advInterval = _advParams.MSEC_TO_ADVERTISEMENT_DURATION_UNITS(advIntMS);
Andrea Palmieri	232:aead10288880	1277	} else {
Andrea Palmieri	232:aead10288880	1278	advInterval = _advParams.getIntervalInADVUnits();
Andrea Palmieri	232:aead10288880	1279	}
Andrea Palmieri	232:aead10288880	1280	}
Andrea Palmieri	232:aead10288880	1281
Andrea Palmieri	232:aead10288880	1282	/**************************************************************************/
Andrea Palmieri	232:aead10288880	1283	/*!
Andrea Palmieri	229:9981f62cdb1a	1284	@brief Set connection parameters according to the current state (ADV and/or SCAN)
Andrea Palmieri	229:9981f62cdb1a	1285	Parameters value is set taking into account guidelines of the BlueNRG
Andrea Palmieri	229:9981f62cdb1a	1286	time slots allocation
Andrea Palmieri	229:9981f62cdb1a	1287	*/
Andrea Palmieri	229:9981f62cdb1a	1288	/**************************************************************************/
Andrea Palmieri	229:9981f62cdb1a	1289	void BlueNRGGap::setConnectionParameters(void)
Andrea Palmieri	229:9981f62cdb1a	1290	{
Andrea Palmieri	229:9981f62cdb1a	1291	if (state.advertising == 1) {
Andrea Palmieri	229:9981f62cdb1a	1292
Andrea Palmieri	232:aead10288880	1293	if (_scanningParams.getInterval() < advInterval) {
Andrea Palmieri	232:aead10288880	1294	PRINTF("state.adv=1 scanInterval<advInterval\r\n");
Andrea Palmieri	232:aead10288880	1295	scanInterval = advInterval;
Andrea Palmieri	232:aead10288880	1296	scanWindow = advInterval;
Andrea Palmieri	229:9981f62cdb1a	1297	} else {
Andrea Palmieri	232:aead10288880	1298	PRINTF("state.adv=1 scanInterval>=advInterval\r\n");
Andrea Palmieri	229:9981f62cdb1a	1299	scanInterval = _scanningParams.getInterval();
Andrea Palmieri	229:9981f62cdb1a	1300	scanWindow = _scanningParams.getWindow();
Andrea Palmieri	229:9981f62cdb1a	1301	}
Andrea Palmieri	234:3f6bba52b307	1302
Andrea Palmieri	234:3f6bba52b307	1303	if(advInterval>(MAX_INT_CONN-(GUARD_INT/1.25))) { //(4000-GUARD_INT)ms
Andrea Palmieri	234:3f6bba52b307	1304	conn_min_interval = MAX_INT_CONN;
Andrea Palmieri	234:3f6bba52b307	1305	conn_max_interval = MAX_INT_CONN;
Andrea Palmieri	234:3f6bba52b307	1306	} else {
Andrea Palmieri	234:3f6bba52b307	1307	conn_min_interval = (_advParams.ADVERTISEMENT_DURATION_UNITS_TO_MS(advInterval)+GUARD_INT)/1.25;
Andrea Palmieri	234:3f6bba52b307	1308	conn_max_interval = (_advParams.ADVERTISEMENT_DURATION_UNITS_TO_MS(advInterval)+GUARD_INT)/1.25;
Andrea Palmieri	234:3f6bba52b307	1309	}
Andrea Palmieri	229:9981f62cdb1a	1310
Andrea Palmieri	229:9981f62cdb1a	1311	} else {
Andrea Palmieri	229:9981f62cdb1a	1312
Andrea Palmieri	232:aead10288880	1313	PRINTF("state.adv = 0\r\n");
Andrea Palmieri	232:aead10288880	1314
Andrea Palmieri	229:9981f62cdb1a	1315	scanInterval = _scanningParams.getInterval();
Andrea Palmieri	229:9981f62cdb1a	1316	scanWindow = _scanningParams.getWindow();
Andrea Palmieri	234:3f6bba52b307	1317	if(SCAN_DURATION_UNITS_TO_MSEC(scanInterval)>(MAX_INT_CONN*1.25) \|\|
Andrea Palmieri	234:3f6bba52b307	1318	SCAN_DURATION_UNITS_TO_MSEC(scanInterval)<(MIN_INT_CONN*1.25)) { //(4000)ms \|\| (7.5)ms
Andrea Palmieri	234:3f6bba52b307	1319	conn_min_interval = DEF_INT_CONN;
Andrea Palmieri	234:3f6bba52b307	1320	conn_max_interval = DEF_INT_CONN;
Andrea Palmieri	234:3f6bba52b307	1321	} else {
Andrea Palmieri	234:3f6bba52b307	1322	conn_min_interval = SCAN_DURATION_UNITS_TO_MSEC(scanInterval)/1.25;
Andrea Palmieri	234:3f6bba52b307	1323	conn_max_interval = SCAN_DURATION_UNITS_TO_MSEC(scanInterval)/1.25;
Andrea Palmieri	234:3f6bba52b307	1324	}
Andrea Palmieri	229:9981f62cdb1a	1325	}
Andrea Palmieri	229:9981f62cdb1a	1326	PRINTF("scanInterval=%u[msec]\r\n",SCAN_DURATION_UNITS_TO_MSEC(scanInterval));
Andrea Palmieri	229:9981f62cdb1a	1327	PRINTF("scanWindow()=%u[msec]\r\n",SCAN_DURATION_UNITS_TO_MSEC(scanWindow));
Andrea Palmieri	234:3f6bba52b307	1328	PRINTF("conn_min_interval=%u[msec]\r\n",(unsigned)(conn_min_interval*1.25));
Andrea Palmieri	234:3f6bba52b307	1329	PRINTF("conn_max_interval=%u[msec]\r\n",(unsigned)(conn_max_interval*1.25));
Andrea Palmieri	229:9981f62cdb1a	1330
Andrea Palmieri	229:9981f62cdb1a	1331	}
Andrea Palmieri	229:9981f62cdb1a	1332
Andrea Palmieri	181:749071129d2e	1333	ble_error_t BlueNRGGap::createConnection ()
Wolfgang Betz	132:51056160fa4a	1334	{
Wolfgang Betz	132:51056160fa4a	1335	tBleStatus ret;
Andrea Palmieri	229:9981f62cdb1a	1336
Andrea Palmieri	229:9981f62cdb1a	1337	/*
Andrea Palmieri	229:9981f62cdb1a	1338	Before creating connection, set parameters according
Andrea Palmieri	229:9981f62cdb1a	1339	to previous or current procedure (ADV and/or SCAN)
Andrea Palmieri	229:9981f62cdb1a	1340	*/
Andrea Palmieri	229:9981f62cdb1a	1341	setConnectionParameters();
Andrea Palmieri	229:9981f62cdb1a	1342
Wolfgang Betz	132:51056160fa4a	1343	/*
Wolfgang Betz	163:4c008b1089e9	1344	Scan_Interval, Scan_Window, Peer_Address_Type, Peer_Address, Own_Address_Type, Conn_Interval_Min,
Wolfgang Betz	163:4c008b1089e9	1345	Conn_Interval_Max, Conn_Latency, Supervision_Timeout, Conn_Len_Min, Conn_Len_Max
Wolfgang Betz	132:51056160fa4a	1346	*/
Andrea Palmieri	229:9981f62cdb1a	1347	ret = aci_gap_create_connection(scanInterval,
Andrea Palmieri	229:9981f62cdb1a	1348	scanWindow,
Andrea Palmieri	229:9981f62cdb1a	1349	_peerAddrType,
Wolfgang Betz	163:4c008b1089e9	1350	(unsigned char*)_peerAddr,
Andrea Palmieri	229:9981f62cdb1a	1351	addr_type,
Andrea Palmieri	229:9981f62cdb1a	1352	conn_min_interval, conn_max_interval, 0,
Andrea Palmieri	238:b6454c839f42	1353	SUPERV_TIMEOUT, CONN_L1, CONN_L1);
Wolfgang Betz	165:3576598c0889	1354
Andrea Palmieri	238:b6454c839f42	1355	//_connecting = false;
Wolfgang Betz	163:4c008b1089e9	1356
Wolfgang Betz	163:4c008b1089e9	1357	if (ret != BLE_STATUS_SUCCESS) {
Andrea Palmieri	229:9981f62cdb1a	1358	PRINTF("Error while starting connection (ret=0x%02X).\n\r", ret);
Wolfgang Betz	132:51056160fa4a	1359	return BLE_ERROR_UNSPECIFIED;
Wolfgang Betz	132:51056160fa4a	1360	} else {
Wolfgang Betz	132:51056160fa4a	1361	PRINTF("Connection started.\n");
Andrea Palmieri	238:b6454c839f42	1362	_connecting = false;
Wolfgang Betz	132:51056160fa4a	1363	return BLE_ERROR_NONE;
Wolfgang Betz	132:51056160fa4a	1364	}
Wolfgang Betz	132:51056160fa4a	1365	}
Wolfgang Betz	132:51056160fa4a	1366
Wolfgang Betz	132:51056160fa4a	1367	ble_error_t BlueNRGGap::connect (const Gap::Address_t peerAddr,
Wolfgang Betz	132:51056160fa4a	1368	Gap::AddressType_t peerAddrType,
Wolfgang Betz	132:51056160fa4a	1369	const ConnectionParams_t *connectionParams,
Wolfgang Betz	132:51056160fa4a	1370	const GapScanningParams *scanParams)
Wolfgang Betz	132:51056160fa4a	1371	{
Andrea Palmieri	142:adf1567d3900	1372	/* avoid compiler warnings about unused variables */
Andrea Palmieri	142:adf1567d3900	1373	(void)connectionParams;
Andrea Palmieri	142:adf1567d3900	1374	(void)scanParams;
Andrea Palmieri	142:adf1567d3900	1375
Andrea Palmieri	217:23870c55b07e	1376	// Save the peer address
Wolfgang Betz	132:51056160fa4a	1377	for(int i=0; i<BDADDR_SIZE; i++) {
Wolfgang Betz	132:51056160fa4a	1378	_peerAddr[i] = peerAddr[i];
Wolfgang Betz	132:51056160fa4a	1379	}
Andrea Palmieri	229:9981f62cdb1a	1380	_peerAddrType = peerAddrType;
Wolfgang Betz	132:51056160fa4a	1381
Andrea Palmieri	181:749071129d2e	1382	_connecting = true;
Wolfgang Betz	132:51056160fa4a	1383
Wolfgang Betz	132:51056160fa4a	1384	if(_scanning) {
Wolfgang Betz	132:51056160fa4a	1385	stopScan();
Wolfgang Betz	132:51056160fa4a	1386	} else {
Wolfgang Betz	165:3576598c0889	1387	PRINTF("Calling createConnection from connect()\n\r");
Wolfgang Betz	165:3576598c0889	1388	return createConnection();
Wolfgang Betz	132:51056160fa4a	1389	}
Wolfgang Betz	132:51056160fa4a	1390
Wolfgang Betz	132:51056160fa4a	1391	return BLE_ERROR_NONE;
Wolfgang Betz	132:51056160fa4a	1392	}
Andrea Palmieri	229:9981f62cdb1a	1393
Andrea Palmieri	229:9981f62cdb1a	1394	/**************************************************************************/
Andrea Palmieri	229:9981f62cdb1a	1395	/*!
Andrea Palmieri	229:9981f62cdb1a	1396	@brief Set the advertising policy filter mode that will be used in
Andrea Palmieri	229:9981f62cdb1a	1397	the next call to startAdvertising().
Andrea Palmieri	229:9981f62cdb1a	1398
Andrea Palmieri	229:9981f62cdb1a	1399	@returns \ref ble_errror_t
Andrea Palmieri	229:9981f62cdb1a	1400
Andrea Palmieri	229:9981f62cdb1a	1401	@retval BLE_ERROR_NONE
Andrea Palmieri	229:9981f62cdb1a	1402	Everything executed properly.
Andrea Palmieri	229:9981f62cdb1a	1403
Andrea Palmieri	229:9981f62cdb1a	1404	BLE_ERROR_NOT_IMPLEMENTED
Andrea Palmieri	229:9981f62cdb1a	1405	This feature is currently note implemented.
Andrea Palmieri	229:9981f62cdb1a	1406	*/
Andrea Palmieri	229:9981f62cdb1a	1407	/**************************************************************************/
Andrea Palmieri	229:9981f62cdb1a	1408	ble_error_t BlueNRGGap::setAdvertisingPolicyMode(Gap::AdvertisingPolicyMode_t mode)
Andrea Palmieri	229:9981f62cdb1a	1409	{
Andrea Palmieri	229:9981f62cdb1a	1410	advertisingPolicyMode = mode;
Andrea Palmieri	229:9981f62cdb1a	1411
Andrea Palmieri	229:9981f62cdb1a	1412	return BLE_ERROR_NONE;
Andrea Palmieri	229:9981f62cdb1a	1413	}
Andrea Palmieri	229:9981f62cdb1a	1414
Andrea Palmieri	229:9981f62cdb1a	1415	/**************************************************************************/
Andrea Palmieri	229:9981f62cdb1a	1416	/*!
Andrea Palmieri	229:9981f62cdb1a	1417	@brief Set the scanning policy filter mode that will be used in
Andrea Palmieri	229:9981f62cdb1a	1418	the next call to startAdvertising().
Andrea Palmieri	229:9981f62cdb1a	1419
Andrea Palmieri	229:9981f62cdb1a	1420	@returns \ref ble_errror_t
Andrea Palmieri	229:9981f62cdb1a	1421
Andrea Palmieri	229:9981f62cdb1a	1422	@retval BLE_ERROR_NONE
Andrea Palmieri	229:9981f62cdb1a	1423	Everything executed properly.
Andrea Palmieri	229:9981f62cdb1a	1424
Andrea Palmieri	229:9981f62cdb1a	1425	BLE_ERROR_NOT_IMPLEMENTED
Andrea Palmieri	229:9981f62cdb1a	1426	This feature is currently note implemented.
Andrea Palmieri	229:9981f62cdb1a	1427	*/
Andrea Palmieri	229:9981f62cdb1a	1428	/**************************************************************************/
Andrea Palmieri	229:9981f62cdb1a	1429	ble_error_t BlueNRGGap::setScanningPolicyMode(Gap::ScanningPolicyMode_t mode)
Andrea Palmieri	229:9981f62cdb1a	1430	{
Andrea Palmieri	229:9981f62cdb1a	1431	scanningPolicyMode = mode;
Andrea Palmieri	229:9981f62cdb1a	1432
Andrea Palmieri	229:9981f62cdb1a	1433	return BLE_ERROR_NONE;
Andrea Palmieri	229:9981f62cdb1a	1434	}
Andrea Palmieri	229:9981f62cdb1a	1435
Andrea Palmieri	229:9981f62cdb1a	1436	/**************************************************************************/
Andrea Palmieri	229:9981f62cdb1a	1437	/*!
Andrea Palmieri	229:9981f62cdb1a	1438	@brief Get the current advertising policy filter mode.
Andrea Palmieri	229:9981f62cdb1a	1439
Andrea Palmieri	229:9981f62cdb1a	1440	@returns The advertising policy filter mode.
Andrea Palmieri	229:9981f62cdb1a	1441	*/
Andrea Palmieri	229:9981f62cdb1a	1442	/**************************************************************************/
Andrea Palmieri	229:9981f62cdb1a	1443	Gap::AdvertisingPolicyMode_t BlueNRGGap::getAdvertisingPolicyMode(void) const
Andrea Palmieri	229:9981f62cdb1a	1444	{
Andrea Palmieri	229:9981f62cdb1a	1445	return advertisingPolicyMode;
Andrea Palmieri	229:9981f62cdb1a	1446	}
Andrea Palmieri	229:9981f62cdb1a	1447
Andrea Palmieri	229:9981f62cdb1a	1448	/**************************************************************************/
Andrea Palmieri	229:9981f62cdb1a	1449	/*!
Andrea Palmieri	229:9981f62cdb1a	1450	@brief Get the current scanning policy filter mode.
Andrea Palmieri	229:9981f62cdb1a	1451
Andrea Palmieri	229:9981f62cdb1a	1452	@returns The scanning policy filter mode.
Andrea Palmieri	229:9981f62cdb1a	1453
Andrea Palmieri	229:9981f62cdb1a	1454	*/
Andrea Palmieri	229:9981f62cdb1a	1455	/**************************************************************************/
Andrea Palmieri	229:9981f62cdb1a	1456	Gap::ScanningPolicyMode_t BlueNRGGap::getScanningPolicyMode(void) const
Andrea Palmieri	229:9981f62cdb1a	1457	{
Andrea Palmieri	229:9981f62cdb1a	1458	return scanningPolicyMode;
Andrea Palmieri	229:9981f62cdb1a	1459	}
Andrea Palmieri	229:9981f62cdb1a	1460
Andrea Palmieri	229:9981f62cdb1a	1461	/**************************************************************************/
Andrea Palmieri	229:9981f62cdb1a	1462	/*!
Andrea Palmieri	229:9981f62cdb1a	1463	@brief Clear BlueNRGGap's state.
Andrea Palmieri	229:9981f62cdb1a	1464
Andrea Palmieri	229:9981f62cdb1a	1465	@returns ble_error_t
Andrea Palmieri	229:9981f62cdb1a	1466
Andrea Palmieri	229:9981f62cdb1a	1467	@retval BLE_ERROR_NONE
Andrea Palmieri	229:9981f62cdb1a	1468	Everything executed properly
Andrea Palmieri	229:9981f62cdb1a	1469	*/
Andrea Palmieri	229:9981f62cdb1a	1470	/**************************************************************************/
Andrea Palmieri	229:9981f62cdb1a	1471	ble_error_t BlueNRGGap::reset(void)
Andrea Palmieri	229:9981f62cdb1a	1472	{
Andrea Palmieri	229:9981f62cdb1a	1473	/* Clear all state that is from the parent, including private members */
Andrea Palmieri	229:9981f62cdb1a	1474	if (Gap::reset() != BLE_ERROR_NONE) {
Andrea Palmieri	229:9981f62cdb1a	1475	return BLE_ERROR_INVALID_STATE;
Andrea Palmieri	229:9981f62cdb1a	1476	}
Andrea Palmieri	229:9981f62cdb1a	1477
Andrea Palmieri	229:9981f62cdb1a	1478	/* Clear derived class members */
Andrea Palmieri	229:9981f62cdb1a	1479	m_connectionHandle = BLE_CONN_HANDLE_INVALID;
Andrea Palmieri	229:9981f62cdb1a	1480
Andrea Palmieri	229:9981f62cdb1a	1481	memset(deviceAppearance, 0, sizeof(deviceAppearance));
Andrea Palmieri	229:9981f62cdb1a	1482	memset(local_name, 0, LOCAL_NAME_MAX_SIZE);
Andrea Palmieri	229:9981f62cdb1a	1483	memset(local_name, 0, UUID_BUFFER_SIZE);
Andrea Palmieri	229:9981f62cdb1a	1484	memset(AdvData, 0, ADV_DATA_MAX_SIZE);
Andrea Palmieri	229:9981f62cdb1a	1485
Andrea Palmieri	229:9981f62cdb1a	1486	/* Set the whitelist policy filter modes to IGNORE_WHITELIST */
Andrea Palmieri	229:9981f62cdb1a	1487	advertisingPolicyMode = Gap::ADV_POLICY_IGNORE_WHITELIST;
Andrea Palmieri	229:9981f62cdb1a	1488	scanningPolicyMode = Gap::SCAN_POLICY_IGNORE_WHITELIST;
Andrea Palmieri	229:9981f62cdb1a	1489
Andrea Palmieri	229:9981f62cdb1a	1490	return BLE_ERROR_NONE;
Andrea Palmieri	229:9981f62cdb1a	1491	}
Andrea Palmieri	229:9981f62cdb1a	1492

Repository toolbox

Export to desktop IDE

Repository details

Type:	Library
Created:	22 Sep 2015
Imports:	1368
Forks:	12
Commits:	308
Dependents:	98
Dependencies:	0
Followers:	426

Components

X-NUCLEO-IDB04A1 Bluetooth Low Energy

X-NUCLEO-IDB05A1 Bluetooth Low Energy