Lorenzo Invidia / Mbed OS ble-star-mbed

This software setup a central node of a star topology network

Dependencies:   MQTT target_st_bluenrg

Fork of ble-star-mbed by Lorenzo Invidia

source/BleSlaveService.cpp@4:4af40af2530e, 2018-03-31 (annotated)

Committer:
lorevee
Date:
Sat Mar 31 15:10:54 2018 +0000
Revision:
4:4af40af2530e
Parent:
3:3f35e80ed848 
first release of ble-star-mbed with cloud support

Who changed what in which revision?

UserRevisionLine numberNew contents of line
lorevee 0:1902469bdd2d 1 #include <BleSlaveService.h>
lorevee 0:1902469bdd2d 2
lorevee 0:1902469bdd2d 3
lorevee 0:1902469bdd2d 4 /* ----- Private variables ----- */
lorevee 0:1902469bdd2d 5 /* Struct of slave dev */
lorevee 0:1902469bdd2d 6 SlaveDevice_t slaveDev;
lorevee 0:1902469bdd2d 7
lorevee 0:1902469bdd2d 8
lorevee 0:1902469bdd2d 9 ChangeNotificationQueue notifyQ, *notifyP;
lorevee 0:1902469bdd2d 10
lorevee 0:1902469bdd2d 11
lorevee 0:1902469bdd2d 12 /* Struct of periph dev */
lorevee 0:1902469bdd2d 13 extern PeripheralDevices_t perDevs;
lorevee 0:1902469bdd2d 14
lorevee 0:1902469bdd2d 15 /* Notification frequency */
lorevee 0:1902469bdd2d 16 uint8_t notification_freq = NOTIFICATION_FREQ_WIFI_OFF;
lorevee 0:1902469bdd2d 17
lorevee 0:1902469bdd2d 18
lorevee 0:1902469bdd2d 19 /* Star Service and Characteristic */
lorevee 0:1902469bdd2d 20 uint8_t sUuid[16] = {0x00,0x00,0x00,0x00,0x00,0x01,0x11,0xe1,0x9a,0xb4,0x00,0x02,0xa5,0xd5,0xc5,0x1b};
lorevee 0:1902469bdd2d 21 uint8_t dataUuid[16] = {0x00,0x08,0x00,0x00,0x00,0x01,0x11,0xe1,0xac,0x36,0x00,0x02,0xa5,0xd5,0xc5,0x1b};
lorevee 0:1902469bdd2d 22 uint8_t confUuid[16] = {0x00,0x04,0x00,0x00,0x00,0x01,0x11,0xe1,0xac,0x36,0x00,0x02,0xa5,0xd5,0xc5,0x1b};
lorevee 0:1902469bdd2d 23
lorevee 0:1902469bdd2d 24
lorevee 0:1902469bdd2d 25 /*---- Create the two characteristic ----*/
lorevee 0:1902469bdd2d 26 /* Config char */
lorevee 0:1902469bdd2d 27 GattCharacteristic configChar(confUuid, slaveDev.star_config_value, STAR_CHAR_MAX_VALUE_LEN, STAR_CHAR_MAX_VALUE_LEN,
lorevee 0:1902469bdd2d 28 GattCharacteristic::BLE_GATT_CHAR_PROPERTIES_NOTIFY|GattCharacteristic::BLE_GATT_CHAR_PROPERTIES_READ|GattCharacteristic::BLE_GATT_CHAR_PROPERTIES_WRITE_WITHOUT_RESPONSE,
lorevee 0:1902469bdd2d 29 NULL, 0, true);
lorevee 0:1902469bdd2d 30
lorevee 0:1902469bdd2d 31
lorevee 0:1902469bdd2d 32 /* Data char */
lorevee 0:1902469bdd2d 33 GattCharacteristic dataChar(dataUuid, slaveDev.notification_data.attribute_value, STAR_CHAR_MAX_VALUE_LEN, STAR_CHAR_MAX_VALUE_LEN,
lorevee 0:1902469bdd2d 34 GattCharacteristic::BLE_GATT_CHAR_PROPERTIES_NOTIFY|GattCharacteristic::BLE_GATT_CHAR_PROPERTIES_READ|GattCharacteristic::BLE_GATT_CHAR_PROPERTIES_WRITE_WITHOUT_RESPONSE,
lorevee 0:1902469bdd2d 35 NULL, 0, true);
lorevee 0:1902469bdd2d 36
lorevee 0:1902469bdd2d 37
lorevee 0:1902469bdd2d 38 /* MANUFACTURER_SPECIFIC_DATA */
lorevee 0:1902469bdd2d 39 uint8_t manuf_data[6] = {
lorevee 0:1902469bdd2d 40 0x01, /*SKD version */
lorevee 0:1902469bdd2d 41 0x81, /* NUCLEO-Board remote */
lorevee 0:1902469bdd2d 42 0x00, /* Led Prox+Lux */ //Unused
lorevee 0:1902469bdd2d 43 0x0C, /* Star Config Char + Star Data Char */ //Unused
lorevee 0:1902469bdd2d 44 0x00, /* SensorFusionShort */ //Unused
lorevee 0:1902469bdd2d 45 0x00 /* SensorFusionFloat */ //Unused
lorevee 0:1902469bdd2d 46 };
lorevee 0:1902469bdd2d 47
lorevee 0:1902469bdd2d 48
lorevee 0:1902469bdd2d 49
lorevee 0:1902469bdd2d 50
lorevee 0:1902469bdd2d 51
lorevee 0:1902469bdd2d 52 /*----------------------------------------------------------------------------*/
lorevee 0:1902469bdd2d 53
lorevee 0:1902469bdd2d 54
lorevee 0:1902469bdd2d 55 /* Set the device as a slave in discoverable mode */
lorevee 0:1902469bdd2d 56 void setSlaveDiscoverable(void) {
lorevee 0:1902469bdd2d 57 //printf("\r\nsetSlaveDiscoverable\n");//DEBUG
lorevee 0:1902469bdd2d 58 BLE& ble = BLE::Instance();
lorevee 0:1902469bdd2d 59 ble_error_t e2;
lorevee 0:1902469bdd2d 60
lorevee 0:1902469bdd2d 61
lorevee 0:1902469bdd2d 62 //if-MAIN - discovery/reading/writing ops completed
lorevee 0:1902469bdd2d 63 if ((discoveryCompleted == 1) /*&& (readCompleted == 1) && (writeDescriptorCompleted == 1)*/){
lorevee 0:1902469bdd2d 64
lorevee 0:1902469bdd2d 65
lorevee 2:1525f4848cf2 66 /* !! Solve advertising after master disconnection */
lorevee 2:1525f4848cf2 67
lorevee 0:1902469bdd2d 68 /* Start advertisng */
lorevee 0:1902469bdd2d 69 if ((!ble.gap().getState().advertising)){
lorevee 0:1902469bdd2d 70 advEnds =0;
lorevee 0:1902469bdd2d 71
lorevee 0:1902469bdd2d 72 printf("\r\nSet Discoverable Mode (%d)\n", perDevs.status);
lorevee 0:1902469bdd2d 73 e2 = ble.gap().startAdvertising();
lorevee 0:1902469bdd2d 74 if ( e2 == BLE_ERROR_NONE ){
lorevee 0:1902469bdd2d 75 /* Giving some time to connect */
lorevee 0:1902469bdd2d 76 eventQ.call_in(7000, stopAdv);//N ms
lorevee 0:1902469bdd2d 77 }else{
lorevee 0:1902469bdd2d 78 printf("\r\nError while starting advertising (err: %d - stat: %d)\n", e2, perDevs.status);
lorevee 0:1902469bdd2d 79 advEnds=1;//terminated because not started
lorevee 0:1902469bdd2d 80 }
lorevee 0:1902469bdd2d 81
lorevee 0:1902469bdd2d 82 }//if-not-adv
lorevee 0:1902469bdd2d 83 }//if-MAIN
lorevee 0:1902469bdd2d 84
lorevee 0:1902469bdd2d 85
lorevee 0:1902469bdd2d 86 //Restart loop ops
lorevee 4:4af40af2530e 87 //perDevs.status = CONN_INIT;
lorevee 4:4af40af2530e 88 //perDevs.discovery_enabled = true;
lorevee 0:1902469bdd2d 89
lorevee 0:1902469bdd2d 90 }
lorevee 0:1902469bdd2d 91 /*----------------------------------------------------------------------------*/
lorevee 0:1902469bdd2d 92
lorevee 0:1902469bdd2d 93
lorevee 0:1902469bdd2d 94
lorevee 0:1902469bdd2d 95 void stopAdv(){
lorevee 0:1902469bdd2d 96
lorevee 0:1902469bdd2d 97 if ((slaveDev.is_connected == false) && (discoveryCompleted == 1)){
lorevee 0:1902469bdd2d 98 if (BLE::Instance().gap().getState().advertising){
lorevee 0:1902469bdd2d 99 ble_error_t e = BLE::Instance().gap().stopAdvertising();
lorevee 0:1902469bdd2d 100 if ( e != BLE_ERROR_NONE ) {
lorevee 0:1902469bdd2d 101 printf("\r\nError stopping ADV\n");//DEBUG
lorevee 0:1902469bdd2d 102 }
lorevee 0:1902469bdd2d 103 }
lorevee 0:1902469bdd2d 104 }//if
lorevee 0:1902469bdd2d 105
lorevee 0:1902469bdd2d 106 advEnds = 1;
lorevee 0:1902469bdd2d 107 }
lorevee 0:1902469bdd2d 108 /*----------------------------------------------------------------------------*/
lorevee 0:1902469bdd2d 109
lorevee 0:1902469bdd2d 110
lorevee 0:1902469bdd2d 111
lorevee 0:1902469bdd2d 112 /**
lorevee 0:1902469bdd2d 113 * @brief This function sets some notification properties (e.g. the
lorevee 0:1902469bdd2d 114 * notification period) by sending a command according to the
lorevee 0:1902469bdd2d 115 * following format:
lorevee 0:1902469bdd2d 116 * FEATURE_MASK (4bytes) + Command (1byte) + Data (1byte)
lorevee 0:1902469bdd2d 117 * In case of the notification period the command is 255 while the allowed data are:
lorevee 0:1902469bdd2d 118 * 50 @5S, 10 @1S, 1 @100mS, 0 @50mS (default).
lorevee 0:1902469bdd2d 119 * @param connection handle
lorevee 0:1902469bdd2d 120 * @param peripheral device index
lorevee 0:1902469bdd2d 121 * @param feature mask
lorevee 0:1902469bdd2d 122 * @param command
lorevee 0:1902469bdd2d 123 * @param data
lorevee 0:1902469bdd2d 124 * @retval None
lorevee 0:1902469bdd2d 125 */
lorevee 0:1902469bdd2d 126 void setNotificationProperty(uint16_t conn_handle, uint8_t i, uint32_t feature_mask,
lorevee 0:1902469bdd2d 127 uint8_t command, uint8_t data) {
lorevee 0:1902469bdd2d 128 //printf("\r\nsetNotificationProperty\n");//DEBUG
lorevee 0:1902469bdd2d 129
lorevee 0:1902469bdd2d 130 uint16_t attr_handle;
lorevee 0:1902469bdd2d 131 uint8_t value_len;
lorevee 0:1902469bdd2d 132 uint8_t attr_value[6];
lorevee 0:1902469bdd2d 133
lorevee 0:1902469bdd2d 134 attr_handle = perDevs.cfg_char_handle[i] + 1;
lorevee 0:1902469bdd2d 135 attr_value[0] = (uint8_t)((feature_mask) >> 24);
lorevee 0:1902469bdd2d 136 attr_value[1] = (uint8_t)((feature_mask) >> 16);
lorevee 0:1902469bdd2d 137 attr_value[2] = (uint8_t)((feature_mask) >> 8);
lorevee 0:1902469bdd2d 138 attr_value[3] = (uint8_t)((feature_mask));
lorevee 0:1902469bdd2d 139 attr_value[4] = command;
lorevee 0:1902469bdd2d 140 attr_value[5] = data;
lorevee 0:1902469bdd2d 141 value_len = 6; /* FEATURE_MASK len (4bytes) + Command len (1byte) + Data len (1byte) */
lorevee 2:1525f4848cf2 142
lorevee 0:1902469bdd2d 143 /* The gatt write function above is w/out response, so we just wait for a short time before going on */
lorevee 0:1902469bdd2d 144 writeCharacValueWithoutResp(conn_handle, attr_handle, value_len, attr_value);
lorevee 4:4af40af2530e 145 HAL_Delay(1000);//N ms
lorevee 0:1902469bdd2d 146 }
lorevee 0:1902469bdd2d 147 /*----------------------------------------------------------------------------*/
lorevee 0:1902469bdd2d 148
lorevee 0:1902469bdd2d 149
lorevee 0:1902469bdd2d 150
lorevee 0:1902469bdd2d 151
lorevee 0:1902469bdd2d 152 /* Forwards to master all notifications from peripherals */
lorevee 0:1902469bdd2d 153 void notifyMaster(uint8_t data_length, uint8_t* attribute_value, uint16_t attribute_handle){
lorevee 0:1902469bdd2d 154 //printf("\r\nnotifyMaster\n");//DEBUG
lorevee 0:1902469bdd2d 155 ble_error_t notifyError;
lorevee 0:1902469bdd2d 156
lorevee 4:4af40af2530e 157 if (slaveDev.is_connected !=0)
lorevee 4:4af40af2530e 158 notifyError = BLE::Instance().gattServer().write(attribute_handle+1, attribute_value, data_length, false);
lorevee 0:1902469bdd2d 159
lorevee 0:1902469bdd2d 160 if (notifyError != BLE_ERROR_NONE){
lorevee 0:1902469bdd2d 161 printf("\r\n(notifyMaster) Error (%d) while updating characteristic\n", notifyError);//BLE_STACK_BUSY
lorevee 1:110b5e896bc9 162 if (notifyError == BLE_STACK_BUSY){
lorevee 1:110b5e896bc9 163 stackBusy = 1;
lorevee 1:110b5e896bc9 164 return;
lorevee 1:110b5e896bc9 165 }
lorevee 1:110b5e896bc9 166 }else {
lorevee 1:110b5e896bc9 167 stackBusy = 0;
lorevee 1:110b5e896bc9 168 return;
lorevee 0:1902469bdd2d 169 }
lorevee 1:110b5e896bc9 170
lorevee 0:1902469bdd2d 171 }
lorevee 0:1902469bdd2d 172 /*----------------------------------------------------------------------------*/
lorevee 0:1902469bdd2d 173
lorevee 0:1902469bdd2d 174
lorevee 0:1902469bdd2d 175 /* Add all services using a vendor specific UUIDs */
lorevee 0:1902469bdd2d 176 void addAllServices(void){
lorevee 0:1902469bdd2d 177
lorevee 0:1902469bdd2d 178 ble_error_t error;
lorevee 0:1902469bdd2d 179 notifyP = &notifyQ;
lorevee 0:1902469bdd2d 180
lorevee 0:1902469bdd2d 181
lorevee 0:1902469bdd2d 182 GattCharacteristic *charTable[] = {&configChar, &dataChar};
lorevee 0:1902469bdd2d 183
lorevee 0:1902469bdd2d 184 /*---- Create the hw service ----*/
lorevee 0:1902469bdd2d 185 GattService starService(sUuid, charTable, sizeof(charTable) / sizeof(GattCharacteristic *));
lorevee 0:1902469bdd2d 186
lorevee 0:1902469bdd2d 187 /*---- Add the hw service ----*/
lorevee 1:110b5e896bc9 188 error = BLE::Instance().gattServer().addService(starService);
lorevee 0:1902469bdd2d 189 slaveDev.star_hw_serv_handle = starService.getHandle();
lorevee 0:1902469bdd2d 190 slaveDev.star_config_char_handle = configChar.getValueHandle()-1; //-1 for decl handle
lorevee 0:1902469bdd2d 191 slaveDev.star_data_char_handle = dataChar.getValueHandle()-1; //-1 for decl handle
lorevee 0:1902469bdd2d 192
lorevee 0:1902469bdd2d 193
lorevee 0:1902469bdd2d 194
lorevee 0:1902469bdd2d 195 if ( error != BLE_ERROR_NONE ){
lorevee 0:1902469bdd2d 196 printf("\r\nError while creating starService(error: %d)\n", error);
lorevee 0:1902469bdd2d 197
lorevee 0:1902469bdd2d 198 } else {
lorevee 0:1902469bdd2d 199 printf("\r\nStar HW Gatt Service added (handle 0x%004x)\n", slaveDev.star_hw_serv_handle);
lorevee 0:1902469bdd2d 200 printf("\rStar HW Config Char added (handle 0x%004x)\n", slaveDev.star_config_char_handle);
lorevee 0:1902469bdd2d 201 printf("\rStar HW Data Char added (handle 0x%004x)", slaveDev.star_data_char_handle);
lorevee 0:1902469bdd2d 202 printf("\r\n");
lorevee 0:1902469bdd2d 203 }
lorevee 0:1902469bdd2d 204
lorevee 0:1902469bdd2d 205 }
lorevee 0:1902469bdd2d 206 /*----------------------------------------------------------------------------*/
lorevee 0:1902469bdd2d 207
lorevee 0:1902469bdd2d 208
lorevee 0:1902469bdd2d 209 /* Disable all notifications */
lorevee 0:1902469bdd2d 210 void disableAllNotifications(void){
lorevee 0:1902469bdd2d 211 //printf("\r\ndisableAllNotifications\n");//DEBUG
lorevee 0:1902469bdd2d 212
lorevee 0:1902469bdd2d 213
lorevee 0:1902469bdd2d 214 uint8_t j;
lorevee 0:1902469bdd2d 215 uint16_t attr_handle;
lorevee 0:1902469bdd2d 216 uint8_t value_len;
lorevee 0:1902469bdd2d 217 uint8_t attr_value[2];
lorevee 0:1902469bdd2d 218 char* feat = NULL;
lorevee 0:1902469bdd2d 219
lorevee 0:1902469bdd2d 220 for (j=0; j<(perDevs.connDevices+perDevs.discDevices); j++) {
lorevee 0:1902469bdd2d 221
lorevee 0:1902469bdd2d 222 if ((perDevs.mic_event[j]) && (perDevs.mic_event_enabled)) {
lorevee 0:1902469bdd2d 223 feat = "MIC";
lorevee 0:1902469bdd2d 224 perDevs.mic_event_enabled = 0;
lorevee 0:1902469bdd2d 225 perDevs.mic_event[j] = 0;
lorevee 0:1902469bdd2d 226 attr_handle = perDevs.mic_char_handle[j] + 2;
lorevee 0:1902469bdd2d 227
lorevee 0:1902469bdd2d 228 } else if ((perDevs.prx_event[j]) && (perDevs.prx_event_enabled)) {
lorevee 0:1902469bdd2d 229 feat = "PRX";
lorevee 0:1902469bdd2d 230 perDevs.prx_event_enabled = 0;
lorevee 0:1902469bdd2d 231 perDevs.prx_on[j] = 0;
lorevee 0:1902469bdd2d 232 attr_handle = perDevs.prx_char_handle[j] + 2;
lorevee 0:1902469bdd2d 233
lorevee 0:1902469bdd2d 234 } else if ((perDevs.agm_event[j]) && (perDevs.agm_event_enabled)) {
lorevee 0:1902469bdd2d 235 feat = "AGM";
lorevee 0:1902469bdd2d 236 perDevs.acc_event_enabled = 0;
lorevee 0:1902469bdd2d 237 perDevs.gyr_event_enabled = 0;
lorevee 0:1902469bdd2d 238 perDevs.mag_event_enabled = 0;
lorevee 0:1902469bdd2d 239 perDevs.agm_event_enabled = 0;
lorevee 0:1902469bdd2d 240 perDevs.agm_on[j] = 0;
lorevee 0:1902469bdd2d 241 attr_handle = perDevs.agm_char_handle[j] + 2;
lorevee 0:1902469bdd2d 242
lorevee 0:1902469bdd2d 243 } else if ((perDevs.sfusion_event[j]) && (perDevs.sfusion_event_enabled)) {
lorevee 0:1902469bdd2d 244 feat = "SFUSION";
lorevee 0:1902469bdd2d 245 perDevs.sfusion_event_enabled = 0;
lorevee 0:1902469bdd2d 246 perDevs.sfusion_on[j] = 0;
lorevee 0:1902469bdd2d 247 attr_handle = perDevs.sfusion_char_handle[j] + 2;
lorevee 0:1902469bdd2d 248
lorevee 0:1902469bdd2d 249 } else {
lorevee 0:1902469bdd2d 250 continue;
lorevee 0:1902469bdd2d 251 }
lorevee 0:1902469bdd2d 252
lorevee 0:1902469bdd2d 253 value_len = 2;
lorevee 0:1902469bdd2d 254 attr_value[0] = DISABLE;
lorevee 0:1902469bdd2d 255
lorevee 0:1902469bdd2d 256
lorevee 0:1902469bdd2d 257 writeDescriptorCompleted=0;
lorevee 0:1902469bdd2d 258 ble_error_t disableErr = writeCharacDescriptorWithError(perDevs.connection_handle[j], attr_handle, value_len, attr_value);
lorevee 0:1902469bdd2d 259 printf("\r\nSet OFF the %s notifications on node %d\n", feat, j);
lorevee 0:1902469bdd2d 260
lorevee 0:1902469bdd2d 261 if (disableErr != BLE_ERROR_NONE){
lorevee 1:110b5e896bc9 262 printf("\r\n(disableAllNotifications) Write charac descriptor failed (err: %d, stat: %d)\n", disableErr, perDevs.status);
lorevee 0:1902469bdd2d 263 writeDescriptorCompleted=1;
lorevee 0:1902469bdd2d 264 }//if-error
lorevee 0:1902469bdd2d 265 }//for
lorevee 0:1902469bdd2d 266 }
lorevee 0:1902469bdd2d 267 /*----------------------------------------------------------------------------*/
lorevee 0:1902469bdd2d 268
lorevee 0:1902469bdd2d 269
lorevee 0:1902469bdd2d 270
lorevee 0:1902469bdd2d 271 /* This function enables or disables the new peripheral scanning */
lorevee 0:1902469bdd2d 272 void setNewNodesScanning(uint8_t enabled){
lorevee 0:1902469bdd2d 273
lorevee 0:1902469bdd2d 274 STORE_LE_16(slaveDev.star_config_value,(HAL_GetTick()>>3)); /* Timestamp */
lorevee 0:1902469bdd2d 275
lorevee 0:1902469bdd2d 276 switch (enabled) {
lorevee 0:1902469bdd2d 277 case 0x01:
lorevee 0:1902469bdd2d 278 perDevs.discovery_enabled = true;
lorevee 4:4af40af2530e 279 // printf("\r\nScanning enabled (%d)\n", enabled);
lorevee 0:1902469bdd2d 280 break;
lorevee 0:1902469bdd2d 281
lorevee 0:1902469bdd2d 282 case 0x02:
lorevee 0:1902469bdd2d 283 perDevs.discovery_enabled = false;
lorevee 4:4af40af2530e 284 // printf("\r\nScanning disabled (%d)\n", enabled);
lorevee 0:1902469bdd2d 285 break;
lorevee 0:1902469bdd2d 286
lorevee 0:1902469bdd2d 287 default:
lorevee 4:4af40af2530e 288 // printf("\r\nScanning set to unrecognized value (%d)\n", enabled);
lorevee 0:1902469bdd2d 289 break;
lorevee 0:1902469bdd2d 290 }
lorevee 0:1902469bdd2d 291
lorevee 0:1902469bdd2d 292 slaveDev.star_config_value[2] = enabled;
lorevee 0:1902469bdd2d 293 slaveDev.star_config_value_len = 3;
lorevee 0:1902469bdd2d 294 //HAL_Delay(300);
lorevee 0:1902469bdd2d 295
lorevee 0:1902469bdd2d 296 /* Notify master for scanning */
lorevee 0:1902469bdd2d 297
lorevee 2:1525f4848cf2 298 /* Check the scan enable/disable */
lorevee 4:4af40af2530e 299 notifyMaster(slaveDev.star_config_value_len, slaveDev.star_config_value,
lorevee 4:4af40af2530e 300 slaveDev.star_config_char_handle);
lorevee 0:1902469bdd2d 301
lorevee 0:1902469bdd2d 302 }
lorevee 0:1902469bdd2d 303 /*----------------------------------------------------------------------------*/
lorevee 0:1902469bdd2d 304
lorevee 0:1902469bdd2d 305
lorevee 0:1902469bdd2d 306 //NOT USED FOR NOW !!
lorevee 0:1902469bdd2d 307 /* This function forwards to the peripheral device the command coming from the Cloud */
lorevee 0:1902469bdd2d 308 void Forward_Command_To_BlueNRG(uint8_t* data_ptr, uint8_t data_length){
lorevee 0:1902469bdd2d 309
lorevee 0:1902469bdd2d 310 uint16_t handle;
lorevee 0:1902469bdd2d 311 uint8_t buffer[4] = {0, 0, 0, 0};
lorevee 0:1902469bdd2d 312 uint8_t num, even, odd;
lorevee 0:1902469bdd2d 313 uint8_t i;
lorevee 0:1902469bdd2d 314 uint8_t cmd_type;
lorevee 0:1902469bdd2d 315
lorevee 0:1902469bdd2d 316 cmd_type = (data_ptr[0] - '0') << 4 | (data_ptr[1] - '0');
lorevee 0:1902469bdd2d 317 //printf("\r\ncommand %d\n", cmd_type);
lorevee 0:1902469bdd2d 318
lorevee 0:1902469bdd2d 319 switch (cmd_type)
lorevee 0:1902469bdd2d 320 {
lorevee 0:1902469bdd2d 321 case 0:
lorevee 0:1902469bdd2d 322 printf("\rScan cmd type (%d)\n", cmd_type);
lorevee 0:1902469bdd2d 323 handle = slaveDev.star_config_char_handle + 1;
lorevee 0:1902469bdd2d 324 break;
lorevee 0:1902469bdd2d 325 case 1:
lorevee 0:1902469bdd2d 326 printf("\rLED/MIC/PRX cmd type (%d)\n", cmd_type);
lorevee 0:1902469bdd2d 327 handle = slaveDev.star_data_char_handle + 1;
lorevee 0:1902469bdd2d 328 break;
lorevee 0:1902469bdd2d 329 default:
lorevee 0:1902469bdd2d 330 printf("\rUnknown cmd type (%d)\n", cmd_type);
lorevee 0:1902469bdd2d 331 return;
lorevee 0:1902469bdd2d 332 //break;
lorevee 0:1902469bdd2d 333 }
lorevee 0:1902469bdd2d 334
lorevee 0:1902469bdd2d 335 /**
lorevee 0:1902469bdd2d 336 * For Scan cmd type:
lorevee 0:1902469bdd2d 337 * |Value |
lorevee 0:1902469bdd2d 338 * |1 byte |
lorevee 0:1902469bdd2d 339 * For LED/MIC/PRX cmd type:
lorevee 0:1902469bdd2d 340 * |Node ID | Type ID | Value |
lorevee 0:1902469bdd2d 341 * |2 bytes | 1 byte | x bytes |
lorevee 0:1902469bdd2d 342 */
lorevee 0:1902469bdd2d 343 for (i=2; i<data_length; i++) {
lorevee 0:1902469bdd2d 344 switch (data_ptr[i])
lorevee 0:1902469bdd2d 345 {
lorevee 0:1902469bdd2d 346 case 'A':
lorevee 0:1902469bdd2d 347 case 'a':
lorevee 0:1902469bdd2d 348 num = 10;
lorevee 0:1902469bdd2d 349 break;
lorevee 0:1902469bdd2d 350 case 'B':
lorevee 0:1902469bdd2d 351 case 'b':
lorevee 0:1902469bdd2d 352 num = 11;
lorevee 0:1902469bdd2d 353 break;
lorevee 0:1902469bdd2d 354 case 'C':
lorevee 0:1902469bdd2d 355 case 'c':
lorevee 0:1902469bdd2d 356 num = 12;
lorevee 0:1902469bdd2d 357 break;
lorevee 0:1902469bdd2d 358 case 'D':
lorevee 0:1902469bdd2d 359 case 'd':
lorevee 0:1902469bdd2d 360 num = 13;
lorevee 0:1902469bdd2d 361 break;
lorevee 0:1902469bdd2d 362 case 'E':
lorevee 0:1902469bdd2d 363 case 'e':
lorevee 0:1902469bdd2d 364 num = 14;
lorevee 0:1902469bdd2d 365 break;
lorevee 0:1902469bdd2d 366 case 'F':
lorevee 0:1902469bdd2d 367 case 'f':
lorevee 0:1902469bdd2d 368 num = 15;
lorevee 0:1902469bdd2d 369 break;
lorevee 0:1902469bdd2d 370 default:
lorevee 0:1902469bdd2d 371 num = data_ptr[i] - '0';
lorevee 0:1902469bdd2d 372 break;
lorevee 0:1902469bdd2d 373 }
lorevee 0:1902469bdd2d 374 if (!(i%2)) {
lorevee 0:1902469bdd2d 375 even = num << 4;
lorevee 0:1902469bdd2d 376 }
lorevee 0:1902469bdd2d 377 else {
lorevee 0:1902469bdd2d 378 odd = num;
lorevee 0:1902469bdd2d 379 buffer[(i-2)/2] = even | odd;
lorevee 0:1902469bdd2d 380 }
lorevee 0:1902469bdd2d 381 }
lorevee 0:1902469bdd2d 382
lorevee 0:1902469bdd2d 383 createAttribute_Modified_CB_Prototype(handle, (data_length-2)/2, buffer);
lorevee 0:1902469bdd2d 384 }
lorevee 0:1902469bdd2d 385 /*----------------------------------------------------------------------------*/
lorevee 0:1902469bdd2d 386
lorevee 0:1902469bdd2d 387
lorevee 0:1902469bdd2d 388 /* Function used to call AttributeModified_CB outside the callback call */
lorevee 0:1902469bdd2d 389 void createAttribute_Modified_CB_Prototype(uint16_t handle, uint8_t data_length, uint8_t *att_data){
lorevee 0:1902469bdd2d 390
lorevee 0:1902469bdd2d 391 GattWriteCallbackParams paramStruct, *pointerToParam;
lorevee 0:1902469bdd2d 392 pointerToParam = &paramStruct;
lorevee 0:1902469bdd2d 393
lorevee 0:1902469bdd2d 394 pointerToParam->handle = handle;
lorevee 0:1902469bdd2d 395 pointerToParam->len = data_length;
lorevee 0:1902469bdd2d 396 pointerToParam->data = att_data;
lorevee 0:1902469bdd2d 397
lorevee 0:1902469bdd2d 398 AttributeModified_CB(pointerToParam);
lorevee 0:1902469bdd2d 399 }
lorevee 0:1902469bdd2d 400 /*----------------------------------------------------------------------------*/
lorevee 0:1902469bdd2d 401
lorevee 0:1902469bdd2d 402
lorevee 0:1902469bdd2d 403
lorevee 0:1902469bdd2d 404
lorevee 0:1902469bdd2d 405 /* This function is called when a local attribute gets modified */
lorevee 0:1902469bdd2d 406 void AttributeModified_CB(const GattWriteCallbackParams* param){
lorevee 4:4af40af2530e 407 //printf("\r\nAttributeModified_CB\n");//DEBUG
lorevee 0:1902469bdd2d 408
lorevee 0:1902469bdd2d 409 /* Assign prototype vars */
lorevee 0:1902469bdd2d 410 uint16_t handle = param->handle;
lorevee 0:1902469bdd2d 411 //uint8_t data_length = param->len; //not used
lorevee 0:1902469bdd2d 412 uint8_t *att_data = (uint8_t *)param->data;
lorevee 0:1902469bdd2d 413
lorevee 0:1902469bdd2d 414
lorevee 0:1902469bdd2d 415 uint8_t i;
lorevee 0:1902469bdd2d 416 uint16_t conn_handle;
lorevee 0:1902469bdd2d 417 uint16_t attr_handle;
lorevee 0:1902469bdd2d 418 uint8_t value_len;
lorevee 0:1902469bdd2d 419 uint8_t attr_value[6];
lorevee 0:1902469bdd2d 420 char* mems;
lorevee 0:1902469bdd2d 421
lorevee 0:1902469bdd2d 422 if (handle == slaveDev.star_config_char_handle + 1) {
lorevee 0:1902469bdd2d 423
lorevee 0:1902469bdd2d 424 perDevs.status = ALL_DATA_READ;
lorevee 0:1902469bdd2d 425 if (att_data[0]==0x01) {
lorevee 0:1902469bdd2d 426 /* Disabling all previously enabled notifications */
lorevee 0:1902469bdd2d 427 disableAllNotifications();
lorevee 0:1902469bdd2d 428 }//if
lorevee 0:1902469bdd2d 429 setNewNodesScanning(att_data[0]);
lorevee 0:1902469bdd2d 430
lorevee 0:1902469bdd2d 431
lorevee 0:1902469bdd2d 432 } else if (handle == slaveDev.star_config_char_handle + 2) {
lorevee 0:1902469bdd2d 433 if (att_data[0]==0x01) {
lorevee 0:1902469bdd2d 434 //printf("\r\nEnable scanning notification\n");
lorevee 0:1902469bdd2d 435 STORE_LE_16(slaveDev.star_config_value,(HAL_GetTick()>>3)); /* Timestamp */
lorevee 0:1902469bdd2d 436 slaveDev.star_config_value[2] = perDevs.discovery_enabled;
lorevee 0:1902469bdd2d 437 slaveDev.star_config_value_len = 3;
lorevee 0:1902469bdd2d 438
lorevee 0:1902469bdd2d 439 /* send the status of the scanning when notifications are enabled */
lorevee 0:1902469bdd2d 440 notifyMaster(slaveDev.star_config_value_len, slaveDev.star_config_value,
lorevee 0:1902469bdd2d 441 slaveDev.star_config_char_handle);
lorevee 0:1902469bdd2d 442
lorevee 0:1902469bdd2d 443 /* enable here the data notifications since sometimes the relative command gets lost (FIXME) */
lorevee 0:1902469bdd2d 444 //printf("\r\nEnable data notification (0)\n");
lorevee 0:1902469bdd2d 445 slaveDev.star_data_char_notify = 1;
lorevee 0:1902469bdd2d 446
lorevee 0:1902469bdd2d 447 } else if (att_data[0]==0x00) {
lorevee 0:1902469bdd2d 448 //printf("\r\nDisable scanning notification\n");
lorevee 0:1902469bdd2d 449 }
lorevee 0:1902469bdd2d 450
lorevee 0:1902469bdd2d 451 } else if (handle == slaveDev.star_data_char_handle + 2) {
lorevee 0:1902469bdd2d 452 if (att_data[0]==0x01) {
lorevee 0:1902469bdd2d 453 //printf("\r\nEnable data notification (1)\n");
lorevee 0:1902469bdd2d 454 slaveDev.star_data_char_notify = 1;
lorevee 0:1902469bdd2d 455
lorevee 0:1902469bdd2d 456
lorevee 0:1902469bdd2d 457 } else if (att_data[0]==0x00) {
lorevee 0:1902469bdd2d 458 //printf("\r\nDisable data notification\n");
lorevee 0:1902469bdd2d 459 slaveDev.star_data_char_notify = 0;
lorevee 0:1902469bdd2d 460
lorevee 0:1902469bdd2d 461 }
lorevee 0:1902469bdd2d 462
lorevee 0:1902469bdd2d 463 } else if (handle == slaveDev.star_data_char_handle + 1) {
lorevee 0:1902469bdd2d 464
lorevee 0:1902469bdd2d 465 /*
lorevee 0:1902469bdd2d 466 * Forward the command to the proper peripheral node.
lorevee 0:1902469bdd2d 467 * It can be:
lorevee 0:1902469bdd2d 468 * - the ON/OFF of a LED
lorevee 0:1902469bdd2d 469 * - the notification enabling/disabling for a MIC Level or a Proximity Sensor
lorevee 0:1902469bdd2d 470 * The coming data are received according to the following format:
lorevee 0:1902469bdd2d 471 * |Node ID | Type ID | value |
lorevee 0:1902469bdd2d 472 * |2 bytes | 1 byte | x bytes |
lorevee 0:1902469bdd2d 473 */
lorevee 0:1902469bdd2d 474
lorevee 0:1902469bdd2d 475 i = Get_Device_Index_From_Addr(att_data);
lorevee 0:1902469bdd2d 476 if ((i < MAX_NUM_OF_NODES) && (!perDevs.is_disconnected[i]) && (perDevs.cfg_char_handle[i] != 0)) {
lorevee 0:1902469bdd2d 477 conn_handle = perDevs.connection_handle[i];
lorevee 0:1902469bdd2d 478
lorevee 0:1902469bdd2d 479 switch (att_data[2]) {
lorevee 0:1902469bdd2d 480
lorevee 0:1902469bdd2d 481
lorevee 0:1902469bdd2d 482 //LED_TYPE_ID
lorevee 0:1902469bdd2d 483 case LED_TYPE_ID:
lorevee 0:1902469bdd2d 484 attr_handle = perDevs.cfg_char_handle[i] + 1;
lorevee 0:1902469bdd2d 485 value_len = 5; /* 4 bytes for the feature mask + 1 byte for the command (0=ON, 1=OFF) */
lorevee 0:1902469bdd2d 486 attr_value[0] = (uint8_t)(((uint32_t)FEATURE_MASK_LED_EVENTS) >> 24);
lorevee 0:1902469bdd2d 487 attr_value[1] = (uint8_t)(((uint32_t)FEATURE_MASK_LED_EVENTS) >> 16);
lorevee 0:1902469bdd2d 488 attr_value[2] = (uint8_t)(((uint32_t)FEATURE_MASK_LED_EVENTS) >> 8);
lorevee 0:1902469bdd2d 489 attr_value[3] = (uint8_t)(((uint32_t)FEATURE_MASK_LED_EVENTS));
lorevee 0:1902469bdd2d 490 attr_value[4] = att_data[3];
lorevee 0:1902469bdd2d 491
lorevee 0:1902469bdd2d 492 writeCharacValueWithoutResp(conn_handle, attr_handle, value_len, attr_value);
lorevee 0:1902469bdd2d 493
lorevee 0:1902469bdd2d 494 perDevs.readDeviceIdx = i;
lorevee 0:1902469bdd2d 495 break;
lorevee 0:1902469bdd2d 496
lorevee 0:1902469bdd2d 497
lorevee 0:1902469bdd2d 498
lorevee 0:1902469bdd2d 499 //MICLEVEL_TYPE_ID
lorevee 0:1902469bdd2d 500 case MICLEVEL_TYPE_ID:
lorevee 0:1902469bdd2d 501
lorevee 0:1902469bdd2d 502 if (readCompleted == 0){
lorevee 0:1902469bdd2d 503 notificationPending = 1;
lorevee 0:1902469bdd2d 504
lorevee 0:1902469bdd2d 505 /* Fill the temp struct */
lorevee 0:1902469bdd2d 506 notifyP->att_data = att_data;
lorevee 0:1902469bdd2d 507 notifyP->attr_value = attr_value;
lorevee 0:1902469bdd2d 508 notifyP->conn_handle = conn_handle;
lorevee 0:1902469bdd2d 509 notifyP->i = i;
lorevee 0:1902469bdd2d 510 notifyP->feature_mask = FEATURE_MASK_MIC;
lorevee 0:1902469bdd2d 511 notifyP->frequency = notification_freq;
lorevee 0:1902469bdd2d 512
lorevee 0:1902469bdd2d 513 /* Then, call the Change_Notification_Status from the readCallback with these params */
lorevee 0:1902469bdd2d 514
lorevee 0:1902469bdd2d 515 }else if (readCompleted == 1) {
lorevee 1:110b5e896bc9 516 //notificationPending = 0;
lorevee 0:1902469bdd2d 517 Change_Notification_Status(att_data, attr_value, conn_handle, i, FEATURE_MASK_MIC, notification_freq);
lorevee 0:1902469bdd2d 518 }
lorevee 0:1902469bdd2d 519 perDevs.prx_on[i] = attr_value[0];
lorevee 0:1902469bdd2d 520 printf("\r\nMIC notifications [%d] %s (status %d, discovery %d)\n", i, (attr_value[0]==1 ? "ON" : "OFF"), perDevs.status, perDevs.discovery_enabled);
lorevee 0:1902469bdd2d 521
lorevee 0:1902469bdd2d 522 #if SCAN_AFTER_NOTIFICATION
lorevee 0:1902469bdd2d 523 /* Restart peripheral discovery and notification*/
lorevee 0:1902469bdd2d 524 if (attr_value[0]!=1){
lorevee 0:1902469bdd2d 525 perDevs.discovery_enabled = 1;
lorevee 0:1902469bdd2d 526 setNewNodesScanning(0x01);
lorevee 0:1902469bdd2d 527 //HAL_Delay(300);
lorevee 0:1902469bdd2d 528 }
lorevee 0:1902469bdd2d 529 #endif
lorevee 0:1902469bdd2d 530 break;
lorevee 0:1902469bdd2d 531
lorevee 0:1902469bdd2d 532
lorevee 0:1902469bdd2d 533
lorevee 0:1902469bdd2d 534
lorevee 0:1902469bdd2d 535
lorevee 0:1902469bdd2d 536 //PRX_TYPE_ID
lorevee 0:1902469bdd2d 537 case PRX_TYPE_ID:
lorevee 0:1902469bdd2d 538
lorevee 0:1902469bdd2d 539 if (readCompleted == 0){
lorevee 0:1902469bdd2d 540 notificationPending = 1;
lorevee 0:1902469bdd2d 541
lorevee 0:1902469bdd2d 542 /* Fill the temp struct */
lorevee 0:1902469bdd2d 543 notifyP->att_data = att_data;
lorevee 0:1902469bdd2d 544 notifyP->attr_value = attr_value;
lorevee 0:1902469bdd2d 545 notifyP->conn_handle = conn_handle;
lorevee 0:1902469bdd2d 546 notifyP->i = i;
lorevee 0:1902469bdd2d 547 notifyP->feature_mask = FEATURE_MASK_PROX;
lorevee 1:110b5e896bc9 548 notifyP->frequency = notification_freq*SENDING_INTERVAL_100MS_MULTIPLE;
lorevee 0:1902469bdd2d 549
lorevee 0:1902469bdd2d 550 /* Then, call the Change_Notification_Status from the readCallback with these params */
lorevee 0:1902469bdd2d 551
lorevee 0:1902469bdd2d 552 }else if (readCompleted == 1) {
lorevee 1:110b5e896bc9 553 //notificationPending = 0;
lorevee 1:110b5e896bc9 554 Change_Notification_Status(att_data, attr_value, conn_handle, i, FEATURE_MASK_PROX, notification_freq*SENDING_INTERVAL_100MS_MULTIPLE);
lorevee 0:1902469bdd2d 555 }
lorevee 0:1902469bdd2d 556 perDevs.prx_on[i] = attr_value[0];
lorevee 0:1902469bdd2d 557 printf("\r\nPRX notifications [%d] %s (status %d)\n", i, (attr_value[0]==1 ? "ON" : "OFF"), perDevs.status);
lorevee 0:1902469bdd2d 558
lorevee 0:1902469bdd2d 559 #if SCAN_AFTER_NOTIFICATION
lorevee 0:1902469bdd2d 560 /* Restart peripheral discovery and notification*/
lorevee 0:1902469bdd2d 561 if (attr_value[0]!=1){
lorevee 0:1902469bdd2d 562 perDevs.discovery_enabled = 1;
lorevee 0:1902469bdd2d 563 setNewNodesScanning(0x01);
lorevee 0:1902469bdd2d 564 //HAL_Delay(300);
lorevee 0:1902469bdd2d 565 }
lorevee 0:1902469bdd2d 566 #endif
lorevee 0:1902469bdd2d 567 break;
lorevee 0:1902469bdd2d 568
lorevee 0:1902469bdd2d 569
lorevee 0:1902469bdd2d 570
lorevee 0:1902469bdd2d 571 //ACC_TYPE_ID
lorevee 0:1902469bdd2d 572 //GYR_TYPE_ID
lorevee 0:1902469bdd2d 573 //MAG_TYPE_ID
lorevee 0:1902469bdd2d 574 case ACC_TYPE_ID:
lorevee 0:1902469bdd2d 575 case GYR_TYPE_ID:
lorevee 0:1902469bdd2d 576 case MAG_TYPE_ID:
lorevee 0:1902469bdd2d 577
lorevee 0:1902469bdd2d 578 if (readCompleted == 0){
lorevee 0:1902469bdd2d 579 notificationPending = 1;
lorevee 0:1902469bdd2d 580
lorevee 0:1902469bdd2d 581 /* Fill the temp struct */
lorevee 0:1902469bdd2d 582 notifyP->att_data = att_data;
lorevee 0:1902469bdd2d 583 notifyP->attr_value = attr_value;
lorevee 0:1902469bdd2d 584 notifyP->conn_handle = conn_handle;
lorevee 0:1902469bdd2d 585 notifyP->i = i;
lorevee 0:1902469bdd2d 586 notifyP->feature_mask = FEATURE_MASK_ACC;
lorevee 3:3f35e80ed848 587 notifyP->frequency = SENDING_INTERVAL_100MS_MULTIPLE;
lorevee 0:1902469bdd2d 588
lorevee 0:1902469bdd2d 589
lorevee 0:1902469bdd2d 590 /* Then, call the Change_Notification_Status from the readCallback with these params */
lorevee 0:1902469bdd2d 591
lorevee 0:1902469bdd2d 592 }else if (readCompleted == 1) {
lorevee 1:110b5e896bc9 593 //notificationPending = 0;
lorevee 3:3f35e80ed848 594 Change_Notification_Status(att_data, attr_value, conn_handle, i, FEATURE_MASK_ACC, SENDING_INTERVAL_100MS_MULTIPLE);
lorevee 0:1902469bdd2d 595 }
lorevee 0:1902469bdd2d 596 perDevs.agm_on[i] = attr_value[0];
lorevee 0:1902469bdd2d 597
lorevee 0:1902469bdd2d 598 if (att_data[2] == 0x09) {
lorevee 0:1902469bdd2d 599 perDevs.acc_event_enabled = attr_value[0];
lorevee 0:1902469bdd2d 600 mems = "ACC";
lorevee 0:1902469bdd2d 601
lorevee 0:1902469bdd2d 602 } else if (att_data[2] == 0x0A) {
lorevee 0:1902469bdd2d 603 perDevs.gyr_event_enabled = attr_value[0];
lorevee 0:1902469bdd2d 604 mems = "GYR";
lorevee 0:1902469bdd2d 605
lorevee 0:1902469bdd2d 606 } else if (att_data[2] == 0x0B) {
lorevee 0:1902469bdd2d 607 perDevs.mag_event_enabled = attr_value[0];
lorevee 0:1902469bdd2d 608 mems = "MAG";
lorevee 0:1902469bdd2d 609 }
lorevee 0:1902469bdd2d 610
lorevee 0:1902469bdd2d 611 printf("\r\nAGM notifications [%d] %s (%s) (status %d)\n", i, (attr_value[0]==1 ? "ON" : "OFF"), mems, perDevs.status);
lorevee 0:1902469bdd2d 612 #if SCAN_AFTER_NOTIFICATION
lorevee 0:1902469bdd2d 613 /* Restart peripheral discovery and notification*/
lorevee 0:1902469bdd2d 614 if (attr_value[0]!=1){
lorevee 0:1902469bdd2d 615 perDevs.discovery_enabled = 1;
lorevee 0:1902469bdd2d 616 setNewNodesScanning(0x01);
lorevee 0:1902469bdd2d 617 //HAL_Delay(300);
lorevee 0:1902469bdd2d 618 }
lorevee 0:1902469bdd2d 619 #endif
lorevee 0:1902469bdd2d 620 break;
lorevee 0:1902469bdd2d 621
lorevee 0:1902469bdd2d 622
lorevee 0:1902469bdd2d 623
lorevee 0:1902469bdd2d 624 //SFUSION_TYPE_ID
lorevee 0:1902469bdd2d 625 case SFUSION_TYPE_ID:
lorevee 0:1902469bdd2d 626
lorevee 0:1902469bdd2d 627 if (readCompleted == 0){
lorevee 0:1902469bdd2d 628 notificationPending = 1;
lorevee 0:1902469bdd2d 629
lorevee 0:1902469bdd2d 630 /* Fill the temp struct */
lorevee 0:1902469bdd2d 631 notifyP->att_data = att_data;
lorevee 0:1902469bdd2d 632 notifyP->attr_value = attr_value;
lorevee 0:1902469bdd2d 633 notifyP->conn_handle = conn_handle;
lorevee 0:1902469bdd2d 634 notifyP->i = i;
lorevee 0:1902469bdd2d 635 notifyP->feature_mask = FEATURE_MASK_SENSORFUSION;
lorevee 3:3f35e80ed848 636 notifyP->frequency = SENDING_INTERVAL_100MS_MULTIPLE;
lorevee 0:1902469bdd2d 637
lorevee 0:1902469bdd2d 638 /* Then, call the Change_Notification_Status from the readCallback with these params */
lorevee 0:1902469bdd2d 639
lorevee 0:1902469bdd2d 640 }else if (readCompleted == 1) {
lorevee 3:3f35e80ed848 641 Change_Notification_Status(att_data, attr_value, conn_handle, i, FEATURE_MASK_SENSORFUSION, SENDING_INTERVAL_100MS_MULTIPLE);
lorevee 0:1902469bdd2d 642 }
lorevee 0:1902469bdd2d 643
lorevee 0:1902469bdd2d 644 perDevs.sfusion_on[i] = attr_value[0];
lorevee 0:1902469bdd2d 645 printf("\r\nSFUSION notifications [%d] %s (status %d)\n", i, (attr_value[0]==1 ? "ON" : "OFF"), perDevs.status);
lorevee 0:1902469bdd2d 646
lorevee 0:1902469bdd2d 647 #if SCAN_AFTER_NOTIFICATION
lorevee 0:1902469bdd2d 648 /* Restart peripheral discovery and notification*/
lorevee 0:1902469bdd2d 649 if (attr_value[0]!=1){
lorevee 0:1902469bdd2d 650 perDevs.discovery_enabled = 1;
lorevee 0:1902469bdd2d 651 setNewNodesScanning(0x01);
lorevee 0:1902469bdd2d 652 //HAL_Delay(300);
lorevee 0:1902469bdd2d 653
lorevee 0:1902469bdd2d 654 }
lorevee 0:1902469bdd2d 655 #endif
lorevee 0:1902469bdd2d 656 break;
lorevee 0:1902469bdd2d 657 }
lorevee 0:1902469bdd2d 658 }//if
lorevee 0:1902469bdd2d 659 }//if-main
lorevee 0:1902469bdd2d 660
lorevee 0:1902469bdd2d 661
lorevee 0:1902469bdd2d 662 }
lorevee 0:1902469bdd2d 663 /*----------------------------------------------------------------------------*/
lorevee 0:1902469bdd2d 664
lorevee 0:1902469bdd2d 665
lorevee 0:1902469bdd2d 666
lorevee 0:1902469bdd2d 667
lorevee 0:1902469bdd2d 668 /* Retrieve the device index from the peripheral device address */
lorevee 0:1902469bdd2d 669 uint8_t Get_Device_Index_From_Addr(uint8_t *addr){
lorevee 0:1902469bdd2d 670
lorevee 0:1902469bdd2d 671 uint8_t i;
lorevee 0:1902469bdd2d 672
lorevee 0:1902469bdd2d 673 for (i=0; i<MAX_NUM_OF_NODES; i++) {
lorevee 0:1902469bdd2d 674
lorevee 0:1902469bdd2d 675 if ((perDevs.devInfo[i].bdaddr[NODE_ID_B2] == addr[0]) && (perDevs.devInfo[i].bdaddr[NODE_ID_B1] == addr[1])) {
lorevee 0:1902469bdd2d 676 return i;
lorevee 0:1902469bdd2d 677 }
lorevee 0:1902469bdd2d 678 }
lorevee 0:1902469bdd2d 679 return MAX_NUM_OF_NODES;
lorevee 0:1902469bdd2d 680 }
lorevee 0:1902469bdd2d 681 /*----------------------------------------------------------------------------*/
lorevee 0:1902469bdd2d 682
lorevee 0:1902469bdd2d 683
lorevee 0:1902469bdd2d 684
lorevee 0:1902469bdd2d 685
lorevee 0:1902469bdd2d 686 /**
lorevee 0:1902469bdd2d 687 * @brief This function is called to Enable/Disable MIC/PRX/AGM/SFusion notifications
lorevee 0:1902469bdd2d 688 * @param att_data : pointer to the modified attribute data
lorevee 0:1902469bdd2d 689 * @param connection handle
lorevee 0:1902469bdd2d 690 * @param peripheral device index
lorevee 0:1902469bdd2d 691 * @param feature mask
lorevee 0:1902469bdd2d 692 * @param notification frequency
lorevee 0:1902469bdd2d 693 * @retval None
lorevee 0:1902469bdd2d 694 */
lorevee 0:1902469bdd2d 695 void Change_Notification_Status(uint8_t *att_data, uint8_t *attr_value, uint16_t conn_handle, uint8_t i,
lorevee 0:1902469bdd2d 696 uint32_t feature_mask, uint8_t frequency) {
lorevee 1:110b5e896bc9 697 //printf("\r\nChange_Notification_Status (status: %d) (read: %s) (write: %s)\n", perDevs.status, (readCompleted == 1 ? "completed" : "pending"),(writeDescriptorCompleted == 1 ? "completed" : "pending"));//DEBUG
lorevee 1:110b5e896bc9 698
lorevee 0:1902469bdd2d 699
lorevee 0:1902469bdd2d 700 uint8_t value_len;
lorevee 0:1902469bdd2d 701 uint16_t attr_handle;
lorevee 0:1902469bdd2d 702
lorevee 0:1902469bdd2d 703
lorevee 0:1902469bdd2d 704 if (att_data[3] == 1) {
lorevee 0:1902469bdd2d 705
lorevee 0:1902469bdd2d 706 /* Setting notification frequency (wait of 2s for writing op)*/
lorevee 0:1902469bdd2d 707 setNotificationProperty(conn_handle, i, feature_mask, NOTIFICATION_FREQ_CMD, frequency);
lorevee 0:1902469bdd2d 708
lorevee 0:1902469bdd2d 709 /* Stopping the scanning for new peripheral nodes */
lorevee 0:1902469bdd2d 710 if (perDevs.discovery_enabled) {
lorevee 0:1902469bdd2d 711 //Disable scanning when notification is enabled
lorevee 0:1902469bdd2d 712 setNewNodesScanning(0x02);
lorevee 0:1902469bdd2d 713 }
lorevee 0:1902469bdd2d 714
lorevee 0:1902469bdd2d 715 /* Disabling all previously enabled notifications */
lorevee 0:1902469bdd2d 716 disableAllNotifications();
lorevee 0:1902469bdd2d 717
lorevee 0:1902469bdd2d 718 }//if
lorevee 0:1902469bdd2d 719
lorevee 0:1902469bdd2d 720
lorevee 0:1902469bdd2d 721
lorevee 0:1902469bdd2d 722
lorevee 0:1902469bdd2d 723 /* Enabling/Disabling notifications */
lorevee 0:1902469bdd2d 724 value_len = 2;
lorevee 0:1902469bdd2d 725 attr_value[0] = att_data[3];
lorevee 0:1902469bdd2d 726
lorevee 0:1902469bdd2d 727 if (feature_mask==FEATURE_MASK_MIC){
lorevee 0:1902469bdd2d 728 attr_handle = perDevs.mic_char_handle[i] + 2;
lorevee 0:1902469bdd2d 729 perDevs.mic_event_enabled = attr_value[0];
lorevee 0:1902469bdd2d 730
lorevee 0:1902469bdd2d 731 } else if (feature_mask==FEATURE_MASK_PROX){
lorevee 0:1902469bdd2d 732 attr_handle = perDevs.prx_char_handle[i] + 2;
lorevee 0:1902469bdd2d 733 perDevs.prx_event_enabled = attr_value[0];
lorevee 0:1902469bdd2d 734
lorevee 0:1902469bdd2d 735 } else if (feature_mask==FEATURE_MASK_ACC){
lorevee 0:1902469bdd2d 736 attr_handle = perDevs.agm_char_handle[i] + 2;
lorevee 0:1902469bdd2d 737 perDevs.agm_event_enabled = attr_value[0];
lorevee 0:1902469bdd2d 738
lorevee 0:1902469bdd2d 739 } else if (feature_mask==FEATURE_MASK_SENSORFUSION){
lorevee 0:1902469bdd2d 740 attr_handle = perDevs.sfusion_char_handle[i] + 2;
lorevee 0:1902469bdd2d 741 perDevs.sfusion_event_enabled = attr_value[0];
lorevee 0:1902469bdd2d 742 }
lorevee 0:1902469bdd2d 743
lorevee 0:1902469bdd2d 744
lorevee 0:1902469bdd2d 745
lorevee 0:1902469bdd2d 746 ble_error_t err;
lorevee 0:1902469bdd2d 747
lorevee 0:1902469bdd2d 748 writeDescriptorCompleted=0;
lorevee 0:1902469bdd2d 749 err = writeCharacDescriptorWithError(conn_handle, attr_handle, value_len, attr_value);
lorevee 0:1902469bdd2d 750
lorevee 0:1902469bdd2d 751 if (err != BLE_ERROR_NONE){
lorevee 0:1902469bdd2d 752 writeDescriptorCompleted=1;
lorevee 0:1902469bdd2d 753 printf("\r\nERROR Enabling/Disabling Notification (err: %d) (stat: %d)\n", err, perDevs.status);
lorevee 1:110b5e896bc9 754
lorevee 0:1902469bdd2d 755 }
lorevee 0:1902469bdd2d 756
lorevee 0:1902469bdd2d 757
lorevee 0:1902469bdd2d 758 /* WUP notification enable/disable */
lorevee 1:110b5e896bc9 759 if(attr_value[0]==0x00){
lorevee 2:1525f4848cf2 760 for (uint8_t j=0; j<(perDevs.connDevices+perDevs.discDevices); j++) {
lorevee 2:1525f4848cf2 761 if (!perDevs.wup_event[j] && perDevs.devInfo[j].dev_v == NODE_ME1 && perDevs.is_connected[j]) {
lorevee 2:1525f4848cf2 762 attr_handle = perDevs.wup_char_handle[j] + 2;
lorevee 2:1525f4848cf2 763 attr_value[0] = 0x01;
lorevee 2:1525f4848cf2 764
lorevee 2:1525f4848cf2 765 setNotificationProperty(perDevs.connection_handle[j], j, FEATURE_MASK_WAKEUP_EVENTS, WAKEUP_NOTIFICATION_CMD, 1);
lorevee 4:4af40af2530e 766
lorevee 2:1525f4848cf2 767 writeDescriptorCompleted=0;
lorevee 2:1525f4848cf2 768 ble_error_t wupErrOn = writeCharacDescriptorWithError(perDevs.connection_handle[j], attr_handle, value_len, attr_value);
lorevee 2:1525f4848cf2 769
lorevee 2:1525f4848cf2 770 if (wupErrOn == BLE_ERROR_NONE){
lorevee 2:1525f4848cf2 771 perDevs.wup_event_enabled = 1;
lorevee 2:1525f4848cf2 772 perDevs.wup_event[j] = 1;
lorevee 2:1525f4848cf2 773 printf("\r\nWUP notification on node [%d] ON\n", j);
lorevee 4:4af40af2530e 774
lorevee 2:1525f4848cf2 775 } else {
lorevee 2:1525f4848cf2 776 printf("\r\nWrite WUP char descriptor failed! (%d)\n", wupErrOn);
lorevee 3:3f35e80ed848 777 writeDescriptorCompleted=1;
lorevee 2:1525f4848cf2 778 }//if-else
lorevee 3:3f35e80ed848 779
lorevee 2:1525f4848cf2 780 }//if
lorevee 2:1525f4848cf2 781 }//for
lorevee 2:1525f4848cf2 782
lorevee 2:1525f4848cf2 783
lorevee 2:1525f4848cf2 784 if (perDevs.wup_event_enabled == 1)
lorevee 2:1525f4848cf2 785 //printf("\r\nAll WUP notifications turned ON\n");//DEBUG
lorevee 2:1525f4848cf2 786 perDevs.status = ALL_DATA_READ;
lorevee 1:110b5e896bc9 787
lorevee 1:110b5e896bc9 788
lorevee 1:110b5e896bc9 789 } else{
lorevee 1:110b5e896bc9 790 for (uint8_t j=0; j<(perDevs.connDevices+perDevs.discDevices); j++) {
lorevee 1:110b5e896bc9 791 if ((perDevs.wup_event[j]) && (perDevs.devInfo[j].dev_v == NODE_ME1) && (perDevs.is_connected[j])) {
lorevee 1:110b5e896bc9 792 attr_handle = perDevs.wup_char_handle[j] + 2;
lorevee 1:110b5e896bc9 793 attr_value[0] = 0x00;
lorevee 1:110b5e896bc9 794
lorevee 1:110b5e896bc9 795
lorevee 1:110b5e896bc9 796 writeDescriptorCompleted=0;
lorevee 1:110b5e896bc9 797 ble_error_t wupErrOff = writeCharacDescriptorWithError(perDevs.connection_handle[j], attr_handle, value_len, attr_value);
lorevee 1:110b5e896bc9 798
lorevee 1:110b5e896bc9 799 if (wupErrOff == BLE_ERROR_NONE){
lorevee 1:110b5e896bc9 800 perDevs.wup_event_enabled = 0;
lorevee 1:110b5e896bc9 801 perDevs.wup_event[j] = 0;
lorevee 1:110b5e896bc9 802 printf("\r\nWUP notification on node [%d] OFF\n", j);
lorevee 1:110b5e896bc9 803
lorevee 1:110b5e896bc9 804 } else {
lorevee 1:110b5e896bc9 805 printf("\r\nWrite WUP char descriptor failed! (%d)\n", wupErrOff);
lorevee 3:3f35e80ed848 806 writeDescriptorCompleted=1;
lorevee 1:110b5e896bc9 807 }
lorevee 3:3f35e80ed848 808
lorevee 1:110b5e896bc9 809 }//if
lorevee 1:110b5e896bc9 810 }//for
lorevee 1:110b5e896bc9 811
lorevee 4:4af40af2530e 812 if (perDevs.wup_event_enabled == 0)
lorevee 4:4af40af2530e 813 //printf("\r\nAll WUP notifications turned OFF\n");//DEBUG
lorevee 1:110b5e896bc9 814 perDevs.status = NOTIFICATIONS_DATA_READ;
lorevee 1:110b5e896bc9 815
lorevee 1:110b5e896bc9 816 }//if-else-wup
lorevee 0:1902469bdd2d 817
lorevee 4:4af40af2530e 818
lorevee 4:4af40af2530e 819
lorevee 0:1902469bdd2d 820 attr_value[0] = att_data[3];
lorevee 0:1902469bdd2d 821 perDevs.readDeviceIdx = i;
lorevee 4:4af40af2530e 822
lorevee 4:4af40af2530e 823 /* No notification is pending anymore */
lorevee 0:1902469bdd2d 824 notificationPending = 0;
lorevee 0:1902469bdd2d 825
lorevee 0:1902469bdd2d 826 //Return to connectionProcess
lorevee 4:4af40af2530e 827 //perDevs.status = CONN_INIT;
lorevee 0:1902469bdd2d 828
lorevee 0:1902469bdd2d 829 }
lorevee 0:1902469bdd2d 830 /*----------------------------------------------------------------------------*/