/** * @brief Add a sample service using a vendor specific profile * @param None * @retval Status */ tBleStatus Add_Sample_Service(void) { tBleStatus ret; /* UUIDs: D973F2E0-B19E-11E2-9E96-0800200C9A66 D973F2E1-B19E-11E2-9E96-0800200C9A66 D973F2E2-B19E-11E2-9E96-0800200C9A66 */ const uint8_t service_uuid[16] = {0x66,0x9a,0x0c,0x20,0x00,0x08,0x96,0x9e,0xe2,0x11,0x9e,0xb1,0xe0,0xf2,0x73,0xd9}; const uint8_t charUuidTX[16] = {0x66,0x9a,0x0c,0x20,0x00,0x08,0x96,0x9e,0xe2,0x11,0x9e,0xb1,0xe1,0xf2,0x73,0xd9}; const uint8_t charUuidRX[16] = {0x66,0x9a,0x0c,0x20,0x00,0x08,0x96,0x9e,0xe2,0x11,0x9e,0xb1,0xe2,0xf2,0x73,0xd9}; ret = aci_gatt_add_serv(UUID_TYPE_128, service_uuid, PRIMARY_SERVICE, 7, &sampleServHandle); /* original is 9?? */ if (ret != BLE_STATUS_SUCCESS) goto fail; ret = aci_gatt_add_char(sampleServHandle, UUID_TYPE_128, charUuidTX, 20, CHAR_PROP_NOTIFY, ATTR_PERMISSION_NONE, 0, 16, 1, &TXCharHandle); if (ret != BLE_STATUS_SUCCESS) goto fail; ret = aci_gatt_add_char(sampleServHandle, UUID_TYPE_128, charUuidRX, 20, CHAR_PROP_WRITE|CHAR_PROP_WRITE_WITHOUT_RESP, ATTR_PERMISSION_NONE, GATT_NOTIFY_ATTRIBUTE_WRITE, 16, 1, &RXCharHandle); if (ret != BLE_STATUS_SUCCESS) goto fail; PRINTF("Sample Service added.\nTX Char Handle %04X, RX Char Handle %04X\n", TXCharHandle, RXCharHandle); return BLE_STATUS_SUCCESS; fail: PRINTF("Error while adding Sample Service.\n"); return BLE_STATUS_ERROR ; }
/******************************************************************************* * Function Name : Add_RemoteControl_Service * Description : 添加远程控制服务 * Input : None * Output : None * Return : None *******************************************************************************/ tBleStatus Add_RemoteControl_Service(void) { tBleStatus ret; uint8_t uuid[16]; /* add service */ COPY_REMOTE_CONTROL_SERVICE_UUID(uuid); ret = aci_gatt_add_serv(UUID_TYPE_128, uuid,PRIMARY_SERVICE,11,&remoteControlServHandle); if(ret != BLE_STATUS_SUCCESS) goto fail; /* add LED Control characteristic */ COPY_LED_CONTROL_UUID(uuid); ret = aci_gatt_add_char(remoteControlServHandle, UUID_TYPE_128, uuid, 20, CHAR_PROP_WRITE | CHAR_PROP_WRITE_WITHOUT_RESP, ATTR_PERMISSION_NONE, GATT_NOTIFY_ATTRIBUTE_WRITE, 16, 1, &ledControlCharHandle); if (ret != BLE_STATUS_SUCCESS) goto fail; return BLE_STATUS_SUCCESS; fail: #ifdef Debug_BlueNRF LOG("Error while adding Remote Control service.\n"); #endif return BLE_STATUS_ERROR ; }
/* Add Service */ tBleStatus Add_Juma_Service(void) { tBleStatus ret; uint8_t service_uuid[16] = { 0x8C, 0xF9, 0x97,0xA6, 0xEE, 0x94, 0xE3,0xBC,0xF8, 0x21, 0xB2, 0x60, 0x00, 0x80, 0x00, 0x00}; uint8_t command_uuid[16] = { 0x8C, 0xF9, 0x97,0xA6, 0xEE, 0x94, 0xE3,0xBC,0xF8, 0x21, 0xB2, 0x60, 0x01, 0x80, 0x00, 0x00}; uint8_t event_char_uuid[16] = { 0x8C, 0xF9, 0x97,0xA6, 0xEE, 0x94, 0xE3,0xBC,0xF8, 0x21, 0xB2, 0x60, 0x02, 0x80, 0x00, 0x00}; uint8_t bulkout_uuid[16] = { 0x8C, 0xF9, 0x97,0xA6, 0xEE, 0x94, 0xE3,0xBC,0xF8, 0x21, 0xB2, 0x60, 0x03, 0x80, 0x00, 0x00}; uint8_t bulkin_uuid[16] = { 0x8C, 0xF9, 0x97,0xA6, 0xEE, 0x94, 0xE3,0xBC,0xF8, 0x21, 0xB2, 0x60, 0x04, 0x80, 0x00, 0x00}; ////add service ret = aci_gatt_add_serv(UUID_TYPE_128, service_uuid, PRIMARY_SERVICE, 11, &testServHandle);//&p_data->service_handle if (ret != BLE_STATUS_SUCCESS) goto fail; ////Add command characteristic ret = aci_gatt_add_char(testServHandle/*p_data->service_handle*/, UUID_TYPE_128, command_uuid, 6, CHAR_PROP_WRITE, ATTR_PERMISSION_NONE, GATT_NOTIFY_ATTRIBUTE_WRITE, 16, 1, &testCharHandle);//&p_data->command_handles // | CHAR_PROP_WRITE//GATT_NOTIFY_ATTRIBUTE_WRITE if (ret != BLE_STATUS_SUCCESS) goto fail; ////Add bulkout characteristic ret = aci_gatt_add_char(testServHandle/*p_data->service_handle*/, UUID_TYPE_128, bulkout_uuid, 6, CHAR_PROP_WRITE_WITHOUT_RESP, ATTR_PERMISSION_NONE, 0, 16, 1, &testCharHandle_2);//&p_data->bulkout_handles //CHAR_PROP_WRITE_WITHOUT_RESP if (ret != BLE_STATUS_SUCCESS) goto fail; ////Add event characteristic ret = aci_gatt_add_char(testServHandle/*p_data->service_handle*/, UUID_TYPE_128, event_char_uuid, 20, CHAR_PROP_NOTIFY|CHAR_PROP_READ, ATTR_PERMISSION_NONE, GATT_NOTIFY_READ_REQ_AND_WAIT_FOR_APPL_RESP, 16, 1, &testCharHandle_3);//&p_data->event_handles if (ret != BLE_STATUS_SUCCESS) goto fail; ////Add bulkin characteristic ret = aci_gatt_add_char(testServHandle/*p_data->service_handle*/, UUID_TYPE_128, bulkin_uuid, 20, CHAR_PROP_NOTIFY, ATTR_PERMISSION_NONE, 0, 16, 1, &testCharHandle_4);//&p_data->bulkin_handles if (ret != BLE_STATUS_SUCCESS) goto fail; return BLE_STATUS_SUCCESS; fail: PRINTF("Error while adding ACC service.\n"); return BLE_STATUS_ERROR ; }
/** *@brief Add Service *@param None *@retval ret */ static uint8_t Add_Service(void) { uint8_t ret; uint8_t service_uuid[16] = { 0x8C, 0xF9, 0x97,0xA6, 0xEE, 0x94, 0xE3,0xBC,0xF8, 0x21, 0xB2, 0x60, 0x00, 0x80, 0x00, 0x00}; uint8_t command_uuid[16] = { 0x8C, 0xF9, 0x97,0xA6, 0xEE, 0x94, 0xE3,0xBC,0xF8, 0x21, 0xB2, 0x60, 0x01, 0x80, 0x00, 0x00}; uint8_t event_char_uuid[16] = { 0x8C, 0xF9, 0x97,0xA6, 0xEE, 0x94, 0xE3,0xBC,0xF8, 0x21, 0xB2, 0x60, 0x02, 0x80, 0x00, 0x00}; uint8_t bulkout_uuid[16] = { 0x8C, 0xF9, 0x97,0xA6, 0xEE, 0x94, 0xE3,0xBC,0xF8, 0x21, 0xB2, 0x60, 0x03, 0x80, 0x00, 0x00}; uint8_t bulkin_uuid[16] = { 0x8C, 0xF9, 0x97,0xA6, 0xEE, 0x94, 0xE3,0xBC,0xF8, 0x21, 0xB2, 0x60, 0x04, 0x80, 0x00, 0x00}; /*add service*/ ret = aci_gatt_add_serv(UUID_TYPE_128, service_uuid, PRIMARY_SERVICE, 11, &BLueNrgServHandle); if (ret != BLE_STATUS_SUCCESS) goto fail; /*Add command characteristic*/ ret = aci_gatt_add_char(BLueNrgServHandle, UUID_TYPE_128, command_uuid, 0x14, CHAR_PROP_WRITE, ATTR_PERMISSION_NONE, GATT_NOTIFY_ATTRIBUTE_WRITE, 16, 1, &WriteCharHandle); if (ret != BLE_STATUS_SUCCESS) goto fail; /*Add bulkout characteristic*/ ret = aci_gatt_add_char(BLueNrgServHandle, UUID_TYPE_128, bulkout_uuid, 0x14, CHAR_PROP_WRITE_WITHOUT_RESP, ATTR_PERMISSION_NONE, 0, 16, 1, &WriteCmdCharHandle);//GATT_NOTIFY_ATTRIBUTE_WRITE if (ret != BLE_STATUS_SUCCESS) goto fail; /*Add event characteristic*/ ret = aci_gatt_add_char(BLueNrgServHandle, UUID_TYPE_128, event_char_uuid, 0x14, CHAR_PROP_NOTIFY|CHAR_PROP_READ, ATTR_PERMISSION_NONE, 0, 16, 1, &ReadNotifyCharHandle);//GATT_NOTIFY_READ_REQ_AND_WAIT_FOR_APPL_RESP if (ret != BLE_STATUS_SUCCESS) goto fail; /*Add bulkin characteristic*/ ret = aci_gatt_add_char(BLueNrgServHandle, UUID_TYPE_128, bulkin_uuid, 0x14, CHAR_PROP_NOTIFY, ATTR_PERMISSION_NONE, 0, 16, 1, &NotifyCharHandle); if (ret != BLE_STATUS_SUCCESS) goto fail; return BLE_STATUS_SUCCESS; fail: return BLE_STATUS_ERROR ; }
ble_error_t BlueNRGGattServer::addService(GattService &service) { /* ToDo: Make sure we don't overflow the array, etc. */ /* ToDo: Make sure this service UUID doesn't already exist (?) */ /* ToDo: Basic validation */ tBleStatus ret; uint8_t type; uint16_t short_uuid; uint8_t primary_short_uuid[2]; uint8_t primary_base_uuid[16]; uint8_t char_base_uuid[16]; const uint8_t *base_uuid; const uint8_t *base_char_uuid; uint8_t charsCount = service.getCharacteristicCount(); const uint8_t available_characteristics = BLE_TOTAL_CHARACTERISTICS - characteristicCount; // check that there is enough characteristics left in the // characteristic array. if (charsCount > available_characteristics) { PRINTF("charCount = %u and characteristicCount = %u\r\n", charsCount, available_characteristics); return BLE_ERROR_NO_MEM; } const uint16_t maxAttrRecords = computeAttributesRecord(service); type = (service.getUUID()).shortOrLong(); PRINTF("AddService(): Type:%d\n\r", type); /* Add the service to the BlueNRG */ short_uuid = (service.getUUID()).getShortUUID(); STORE_LE_16(primary_short_uuid, short_uuid); if(type==UUID::UUID_TYPE_LONG) { base_uuid = (service.getUUID()).getBaseUUID(); COPY_UUID_128(primary_base_uuid, base_uuid[15],base_uuid[14],primary_short_uuid[1],primary_short_uuid[0],base_uuid[11],base_uuid[10],base_uuid[9],base_uuid[8],base_uuid[7],base_uuid[6],base_uuid[5],base_uuid[4],base_uuid[3],base_uuid[2],base_uuid[1],base_uuid[0]); } ret = BLE_STATUS_SUCCESS; if(type==UUID::UUID_TYPE_SHORT) { ret = aci_gatt_add_serv(UUID_TYPE_16, primary_short_uuid, PRIMARY_SERVICE, maxAttrRecords/*7*/, &servHandle); PRINTF("aci_gatt_add_serv UUID_TYPE_SHORT ret=%d\n\r", ret); } else if(type==UUID::UUID_TYPE_LONG) { ret = aci_gatt_add_serv(UUID_TYPE_128, primary_base_uuid, PRIMARY_SERVICE, maxAttrRecords/*7*/, &servHandle); PRINTF("aci_gatt_add_serv UUID_TYPE_LONG ret=%d\n\r", ret); } switch (ret) { case BLE_STATUS_SUCCESS: break; case BLE_STATUS_INVALID_PARAMETER: return BLE_ERROR_INVALID_PARAM; case BLE_STATUS_OUT_OF_HANDLE: case BLE_STATUS_INSUFFICIENT_RESOURCES: case ERR_UNSPECIFIED_ERROR: return BLE_ERROR_NO_MEM; case BLE_STATUS_ERROR: default: return BLE_ERROR_INTERNAL_STACK_FAILURE; } service.setHandle(servHandle); //serviceHandleVector.push_back(servHandle); PRINTF("added servHandle handle =%u\n\r", servHandle); uint16_t bleCharacteristic; //iterate to include all characteristics for (uint8_t i = 0; i < charsCount; i++) { GattCharacteristic *p_char = service.getCharacteristic(i); uint16_t char_uuid = (p_char->getValueAttribute().getUUID()).getShortUUID(); uint8_t int_8_uuid[2]; STORE_LE_16(int_8_uuid, char_uuid); type = (p_char->getValueAttribute().getUUID()).shortOrLong(); if(type==UUID::UUID_TYPE_LONG) { base_char_uuid = (p_char->getValueAttribute().getUUID()).getBaseUUID(); #ifdef DEBUG for(uint8_t j=0; j<16; j++) { PRINTF("base_char_uuid[%d] 0x%02x ", j, base_char_uuid[j]); } PRINTF("\n\r"); #endif COPY_UUID_128(char_base_uuid,base_char_uuid[15],base_char_uuid[14],int_8_uuid[1],int_8_uuid[0],base_char_uuid[11],base_char_uuid[10],base_char_uuid[9],base_char_uuid[8],base_char_uuid[7],base_char_uuid[6],base_char_uuid[5],base_char_uuid[4],base_char_uuid[3],base_char_uuid[2],base_char_uuid[1],base_char_uuid[0]); } PRINTF("Char Properties 0x%x\n\r", p_char->getProperties()); /* * Gatt_Evt_Mask -> HardCoded (0) * Encryption_Key_Size -> Hardcoded (16) * isVariable (variable length value field) -> Hardcoded (1) */ uint8_t Gatt_Evt_Mask = 0x0; if((p_char->getProperties() & (GattCharacteristic::BLE_GATT_CHAR_PROPERTIES_WRITE_WITHOUT_RESPONSE| GattCharacteristic::BLE_GATT_CHAR_PROPERTIES_WRITE))) { PRINTF("Setting up Gatt GATT_NOTIFY_ATTRIBUTE_WRITE Mask\n\r"); Gatt_Evt_Mask = Gatt_Evt_Mask | GATT_NOTIFY_ATTRIBUTE_WRITE | GATT_NOTIFY_WRITE_REQ_AND_WAIT_FOR_APPL_RESP; } if((p_char->getProperties() & (GattCharacteristic::BLE_GATT_CHAR_PROPERTIES_READ| GattCharacteristic::BLE_GATT_CHAR_PROPERTIES_NOTIFY| GattCharacteristic::BLE_GATT_CHAR_PROPERTIES_INDICATE))) { PRINTF("Setting up Gatt GATT_NOTIFY_READ_REQ_AND_WAIT_FOR_APPL_RESP Mask\n\r"); Gatt_Evt_Mask = Gatt_Evt_Mask | GATT_NOTIFY_READ_REQ_AND_WAIT_FOR_APPL_RESP; } //This will support also GATT_SERVER_ATTR_READ_WRITE since it will be covered by previous if() check. if(type==UUID::UUID_TYPE_SHORT) { ret = aci_gatt_add_char(service.getHandle(), UUID_TYPE_16, int_8_uuid, p_char->getValueAttribute().getMaxLength() /*2*/ /*Value Length*/, p_char->getProperties(), ATTR_PERMISSION_NONE, Gatt_Evt_Mask /*Gatt_Evt_Mask*/, 16 /*Encryption_Key_Size*/, 1 /*isVariable*/, &bleCharacteristic); PRINTF("aci_gatt_add_char UUID_TYPE_16 props=%d MaxLength=%d ret=%d\n\r", p_char->getProperties(), p_char->getValueAttribute().getMaxLength(), ret); } else if(type==UUID::UUID_TYPE_LONG) { ret = aci_gatt_add_char(service.getHandle(), UUID_TYPE_128, char_base_uuid, p_char->getValueAttribute().getMaxLength() /*2*/ /*Value Length*/, p_char->getProperties(), ATTR_PERMISSION_NONE, Gatt_Evt_Mask /*Gatt_Evt_Mask*/, 16 /*Encryption_Key_Size*/, 1 /*isVariable*/, &bleCharacteristic); PRINTF("aci_gatt_add_char UUID_TYPE_128 props=%d MaxLength=%d ret=%d\n\r", p_char->getProperties(), p_char->getValueAttribute().getMaxLength(), ret); } switch (ret) { case BLE_STATUS_SUCCESS: break; case ERR_UNSPECIFIED_ERROR: case BLE_STATUS_INSUFFICIENT_RESOURCES: case BLE_STATUS_OUT_OF_HANDLE: // TODO remove characteristics and the service previously added. // remove service in the stack by using: Aci_Gatt_Del_Service // remove characteristics in the stack by using: Aci_Gatt_Del_Char // update service counter // destroy registered characteristic and updat echaracteristic counter return BLE_ERROR_NO_MEM; case BLE_STATUS_INVALID_HANDLE: case BLE_STATUS_INVALID_PARAMETER: case BLE_STATUS_CHARAC_ALREADY_EXISTS: // TODO remove characteristics and the service previously added. // remove service in the stack by using: Aci_Gatt_Del_Service // remove characteristics in the stack by using: Aci_Gatt_Del_Char // update service counter // destroy registered characteristic and updat echaracteristic counter return BLE_ERROR_INVALID_PARAM; case BLE_STATUS_ERROR: default: // TODO remove characteristics and the service previously added. // remove service in the stack by using: Aci_Gatt_Del_Service // remove characteristics in the stack by using: Aci_Gatt_Del_Char // update service counter // destroy registered characteristic and updat echaracteristic counter return BLE_ERROR_INTERNAL_STACK_FAILURE; } bleCharHandleMap.insert(std::pair<uint16_t, uint16_t>(bleCharacteristic, servHandle)); p_characteristics[characteristicCount++] = p_char; /* Set the characteristic value handle */ p_char->getValueAttribute().setHandle(bleCharacteristic+BlueNRGGattServer::CHAR_VALUE_HANDLE); PRINTF("added bleCharacteristic (value handle =%u)\n\r", p_char->getValueAttribute().getHandle()); if ((p_char->getValueAttribute().getValuePtr() != NULL) && (p_char->getValueAttribute().getLength() > 0)) { ble_error_t err = write(p_char->getValueAttribute().getHandle(), p_char->getValueAttribute().getValuePtr(), p_char->getValueAttribute().getLength(), false /* localOnly */); if (err) { PRINTF("ERROR HERE !!!!\r\n"); return err; } } // add descriptors now uint16_t descHandle = 0; PRINTF("p_char->getDescriptorCount()=%d\n\r", p_char->getDescriptorCount()); for(uint8_t descIndex=0; descIndex<p_char->getDescriptorCount(); descIndex++) { GattAttribute *descriptor = p_char->getDescriptor(descIndex); uint8_t desc_uuid[16] = { 0 }; uint8_t desc_uuid_type = CHAR_DESC_TYPE_16_BIT; STORE_LE_16(desc_uuid, descriptor->getUUID().getShortUUID()); if((descriptor->getUUID()).shortOrLong() == UUID::UUID_TYPE_LONG) { desc_uuid_type = CHAR_DESC_TYPE_128_BIT; const uint8_t* base_desc_uuid = descriptor->getUUID().getBaseUUID(); COPY_UUID_128(desc_uuid, base_desc_uuid[15], base_desc_uuid[14],base_desc_uuid[13],base_desc_uuid[12], base_desc_uuid[11], base_desc_uuid[10], base_desc_uuid[9], base_desc_uuid[8], base_desc_uuid[7], base_desc_uuid[6], base_desc_uuid[5], base_desc_uuid[4], base_desc_uuid[3], base_desc_uuid[2], base_desc_uuid[1], base_desc_uuid[0]); } ret = aci_gatt_add_char_desc(service.getHandle(), bleCharacteristic, desc_uuid_type, desc_uuid, descriptor->getMaxLength(), descriptor->getLength(), descriptor->getValuePtr(), CHAR_DESC_SECURITY_PERMISSION, CHAR_DESC_ACCESS_PERMISSION, GATT_NOTIFY_ATTRIBUTE_WRITE, MIN_ENCRY_KEY_SIZE, CHAR_ATTRIBUTE_LEN_IS_FIXED, &descHandle); PRINTF("Adding Descriptor descriptor handle=%d ret=%d\n\r", descHandle, ret); switch (ret) { case BLE_STATUS_SUCCESS: PRINTF("Descriptor added successfully, descriptor handle=%d\n\r", descHandle); descriptor->setHandle(descHandle); break; case ERR_UNSPECIFIED_ERROR: case BLE_STATUS_INSUFFICIENT_RESOURCES: case BLE_STATUS_OUT_OF_HANDLE: // TODO remove characteristics and the service previously added. // remove service in the stack by using: Aci_Gatt_Del_Service // remove characteristics in the stack by using: Aci_Gatt_Del_Char // update service counter // destroy registered characteristic and updat echaracteristic counter return BLE_ERROR_NO_MEM; case BLE_STATUS_INVALID_HANDLE: case BLE_STATUS_INVALID_PARAMETER: // TODO remove characteristics and the service previously added. // remove service in the stack by using: Aci_Gatt_Del_Service // remove characteristics in the stack by using: Aci_Gatt_Del_Char // update service counter // destroy registered characteristic and updat echaracteristic counter return BLE_ERROR_INVALID_PARAM; case BLE_STATUS_INVALID_OPERATION: return BLE_ERROR_OPERATION_NOT_PERMITTED; case BLE_STATUS_ERROR: default: // TODO remove characteristics and the service previously added. // remove service in the stack by using: Aci_Gatt_Del_Service // remove characteristics in the stack by using: Aci_Gatt_Del_Char // update service counter // destroy registered characteristic and updat echaracteristic counter return BLE_ERROR_INTERNAL_STACK_FAILURE; } } } serviceCount++; //FIXME: There is no GattService pointer array in GattServer. // There should be one? (Only the user is aware of GattServices!) Report to forum. return BLE_ERROR_NONE; }
ble_error_t BlueNRGGattServer::addService(GattService &service) { /* ToDo: Make sure we don't overflow the array, etc. */ /* ToDo: Make sure this service UUID doesn't already exist (?) */ /* ToDo: Basic validation */ tBleStatus ret; uint8_t type; uint16_t short_uuid; uint8_t primary_short_uuid[2]; uint8_t primary_base_uuid[16]; uint8_t char_base_uuid[16]; const uint8_t *base_uuid; const uint8_t *base_char_uuid; uint8_t charsCount = 0; uint8_t maxAttrRecords = 0; type = (service.getUUID()).shortOrLong(); PRINTF("AddService(): Type:%d\n\r", type); /* Add the service to the BlueNRG */ short_uuid = (service.getUUID()).getShortUUID(); STORE_LE_16(primary_short_uuid, short_uuid); if(type==UUID::UUID_TYPE_LONG) { base_uuid = (service.getUUID()).getBaseUUID(); COPY_UUID_128(primary_base_uuid, base_uuid[15],base_uuid[14],primary_short_uuid[1],primary_short_uuid[0],base_uuid[11],base_uuid[10],base_uuid[9],base_uuid[8],base_uuid[7],base_uuid[6],base_uuid[5],base_uuid[4],base_uuid[3],base_uuid[2],base_uuid[1],base_uuid[0]); } charsCount = service.getCharacteristicCount(); //1(service record)+2records*char+1record*char_desc maxAttrRecords = 1+3*charsCount; if(type==UUID::UUID_TYPE_SHORT) { ret = aci_gatt_add_serv(UUID_TYPE_16, primary_short_uuid, PRIMARY_SERVICE, maxAttrRecords/*7*/, &servHandle); PRINTF("aci_gatt_add_serv UUID_TYPE_LONG ret=%d\n\r", ret); } else if(type==UUID::UUID_TYPE_LONG) { ret = aci_gatt_add_serv(UUID_TYPE_128, primary_base_uuid, PRIMARY_SERVICE, maxAttrRecords/*7*/, &servHandle); PRINTF("aci_gatt_add_serv UUID_TYPE_LONG ret=%d\n\r", ret); } service.setHandle(servHandle); //serviceHandleVector.push_back(servHandle); PRINTF("added servHandle handle =%u\n\r", servHandle); uint16_t bleCharacteristic; //iterate to include all characteristics for (uint8_t i = 0; i < charsCount; i++) { GattCharacteristic *p_char = service.getCharacteristic(i); uint16_t char_uuid = (p_char->getValueAttribute().getUUID()).getShortUUID(); uint8_t int_8_uuid[2]; STORE_LE_16(int_8_uuid, char_uuid); if(type==UUID::UUID_TYPE_LONG) { base_char_uuid = (p_char->getValueAttribute().getUUID()).getBaseUUID(); COPY_UUID_128(char_base_uuid,base_char_uuid[15],base_char_uuid[14],int_8_uuid[1],int_8_uuid[0],base_char_uuid[11],base_char_uuid[10],base_char_uuid[9],base_char_uuid[8],base_char_uuid[7],base_char_uuid[6],base_char_uuid[5],base_char_uuid[4],base_char_uuid[3],base_char_uuid[2],base_char_uuid[1],base_char_uuid[0]); } PRINTF("Char Properties 0x%x\n\r", p_char->getProperties()); /* * Gatt_Evt_Mask -> HardCoded (0) * Encryption_Key_Size -> Hardcoded (16) * isVariable (variable length value field) -> Hardcoded (1) */ uint8_t Gatt_Evt_Mask = 0x0; if((p_char->getProperties() & (GattCharacteristic::BLE_GATT_CHAR_PROPERTIES_WRITE_WITHOUT_RESPONSE| GattCharacteristic::BLE_GATT_CHAR_PROPERTIES_WRITE))) { PRINTF("Setting up Gatt GATT_NOTIFY_ATTRIBUTE_WRITE Mask\n\r"); Gatt_Evt_Mask = Gatt_Evt_Mask | GATT_NOTIFY_ATTRIBUTE_WRITE; } if((p_char->getProperties() & (GattCharacteristic::BLE_GATT_CHAR_PROPERTIES_READ| GattCharacteristic::BLE_GATT_CHAR_PROPERTIES_NOTIFY| GattCharacteristic::BLE_GATT_CHAR_PROPERTIES_INDICATE))) { PRINTF("Setting up Gatt GATT_NOTIFY_READ_REQ_AND_WAIT_FOR_APPL_RESP Mask\n\r"); Gatt_Evt_Mask = Gatt_Evt_Mask | GATT_NOTIFY_READ_REQ_AND_WAIT_FOR_APPL_RESP; } //This will support also GATT_SERVER_ATTR_READ_WRITE since it will be covered by previous if() check. if(type==UUID::UUID_TYPE_SHORT) { ret = aci_gatt_add_char(service.getHandle(), UUID_TYPE_16, int_8_uuid, p_char->getValueAttribute().getMaxLength() /*2*/ /*Value Length*/, p_char->getProperties(), ATTR_PERMISSION_NONE, Gatt_Evt_Mask /*Gatt_Evt_Mask*/, 16 /*Encryption_Key_Size*/, 1 /*isVariable*/, &bleCharacteristic); PRINTF("aci_gatt_add_char UUID_TYPE_16 props=%d MaxLength=%d ret=%d\n\r", p_char->getProperties(), p_char->getValueAttribute().getMaxLength(), ret); } else if(type==UUID::UUID_TYPE_LONG) { ret = aci_gatt_add_char(service.getHandle(), UUID_TYPE_128, char_base_uuid, p_char->getValueAttribute().getMaxLength() /*2*/ /*Value Length*/, p_char->getProperties(), ATTR_PERMISSION_NONE, Gatt_Evt_Mask /*Gatt_Evt_Mask*/, 16 /*Encryption_Key_Size*/, 1 /*isVariable*/, &bleCharacteristic); PRINTF("aci_gatt_add_char UUID_TYPE_128 props=%d MaxLength=%d ret=%d\n\r", p_char->getProperties(), p_char->getValueAttribute().getMaxLength(), ret); } /* Update the characteristic handle */ //uint16_t charHandle = characteristicCount; bleCharHanldeMap.insert(std::pair<uint16_t, uint16_t>(bleCharacteristic, servHandle)); p_characteristics[characteristicCount++] = p_char; p_char->getValueAttribute().setHandle(bleCharacteristic); //Set the characteristic count as the corresponding char handle PRINTF("added bleCharacteristic handle =%u\n\r", bleCharacteristic); if ((p_char->getValueAttribute().getValuePtr() != NULL) && (p_char->getValueAttribute().getLength() > 0)) { write(p_char->getValueAttribute().getHandle(), p_char->getValueAttribute().getValuePtr(), p_char->getValueAttribute().getLength(), false /* localOnly */); } // add descriptors now uint16_t descHandle = 0; PRINTF("p_char->getDescriptorCount()=%d\n\r", p_char->getDescriptorCount()); for(uint8_t descIndex=0; descIndex<p_char->getDescriptorCount(); descIndex++) { GattAttribute *descriptor = p_char->getDescriptor(descIndex); uint16_t shortUUID = descriptor->getUUID().getShortUUID(); const uint8_t uuidArray[] = {(uint8_t)((shortUUID>>8)&0xFF), (uint8_t)((shortUUID&0xFF))}; ret = aci_gatt_add_char_desc(service.getHandle(), p_char->getValueAttribute().getHandle(), CHAR_DESC_TYPE_16_BIT, uuidArray, descriptor->getMaxLength(), descriptor->getLength(), descriptor->getValuePtr(), CHAR_DESC_SECURITY_PERMISSION, CHAR_DESC_ACCESS_PERMISSION, GATT_NOTIFY_ATTRIBUTE_WRITE, MIN_ENCRY_KEY_SIZE, CHAR_ATTRIBUTE_LEN_IS_FIXED, &descHandle); PRINTF("Adding Descriptor descriptor handle=%d ret=%d\n\r", descHandle, ret); if(ret==(tBleStatus)0) { PRINTF("Descriptor added successfully, descriptor handle=%d\n\r", descHandle); descriptor->setHandle(descHandle); } } } serviceCount++; //FIXME: There is no GattService pointer array in GattServer. // There should be one? (Only the user is aware of GattServices!) Report to forum. return BLE_ERROR_NONE; }