HM_IOT_Demo / Mbed 2 deprecated BLE_Central_Light_Demo_23

Working Code

Dependencies:   BLE_API mbed nRF51822

Fork of BLE_Central_Light_Demo by HM_IOT_Demo

main.cpp@10:5e5fa5bf77b5, 2017-01-30 (annotated)

Committer:
hmiot
Date:
Mon Jan 30 15:20:48 2017 +0000
Revision:
10:5e5fa5bf77b5
Parent:
9:b967a01810e1
Child:
11:58d8a3129877
SPI Communication working.

Who changed what in which revision?

UserRevisionLine numberNew contents of line
hmiot 7:66586d2d7cb5 1 /************************************************************************
hmiot 7:66586d2d7cb5 2 * *
hmiot 7:66586d2d7cb5 3 * *
hmiot 7:66586d2d7cb5 4 ************************************************************************/
hmiot 6:71e7a446ae6a 5
hmiot 7:66586d2d7cb5 6 #include "hm_config.h"
hmiot 9:b967a01810e1 7 //#include "rtos.h"
hmiot 7:66586d2d7cb5 8
hmiot 6:71e7a446ae6a 9 DiscoveredCharacteristic lightCharacteristic;
hmiot 8:285ebd0e83fb 10 s_serviceInfo lightChar = {NULL,NULL,NULL,NULL};
hmiot 6:71e7a446ae6a 11 Serial pc(USBTX, USBRX);
hmiot 6:71e7a446ae6a 12
hmiot 9:b967a01810e1 13 void bleint();
hmiot 9:b967a01810e1 14 void SPI_Slave_read();
hmiot 10:5e5fa5bf77b5 15 void waitBleEvent();
hmiot 10:5e5fa5bf77b5 16 void ble_actions(int spi_data);
hmiot 9:b967a01810e1 17
hmiot 8:285ebd0e83fb 18 SPISlave spiSlave(P0_9, P0_11, P0_8, P0_10);
hmiot 8:285ebd0e83fb 19
mbed_tw_hoehoe 3:d6f80e11a7f4 20
hmiot 6:71e7a446ae6a 21 void advertisementCallback(const Gap::AdvertisementCallbackParams_t *params) {
hmiot 6:71e7a446ae6a 22 uint8_t con_status =0;
hmiot 6:71e7a446ae6a 23 //0x51 for Magic light
hmiot 6:71e7a446ae6a 24 //0x5A
hmiot 9:b967a01810e1 25 if (params->peerAddr[0] == 0x51) { // 0x2F for red bear1.5 /* !ALERT! Alter this filter to suit your device. */
hmiot 8:285ebd0e83fb 26
hmiot 8:285ebd0e83fb 27 pc.printf("adv peerAddr[%02x %02x %02x %02x %02x %02x] rssi %d, isScanResponse %u, AdvertisementType %u\r\n",
mbed_tw_hoehoe 0:83b5c6efd8d7 28 params->peerAddr[5], params->peerAddr[4], params->peerAddr[3], params->peerAddr[2], params->peerAddr[1], params->peerAddr[0],
mbed_tw_hoehoe 0:83b5c6efd8d7 29 params->rssi, params->isScanResponse, params->type);
hmiot 6:71e7a446ae6a 30 pc.printf("Data Length : %d\r\n",params->advertisingDataLen);
hmiot 8:285ebd0e83fb 31 con_status = BLE::Instance().gap().connect(params->peerAddr, Gap::ADDR_TYPE_PUBLIC, NULL, NULL);
hmiot 8:285ebd0e83fb 32 pc.printf("Connection Status : %d\r\n",con_status);
hmiot 8:285ebd0e83fb 33 connect_status = 1;
hmiot 8:285ebd0e83fb 34 BLE::Instance().gap().stopScan();
hmiot 9:b967a01810e1 35
hmiot 8:285ebd0e83fb 36 }else{
hmiot 8:285ebd0e83fb 37 printf("Not Matched your device\r\n");
hmiot 9:b967a01810e1 38 return;
hmiot 8:285ebd0e83fb 39 }
hmiot 8:285ebd0e83fb 40 }
mbed_tw_hoehoe 0:83b5c6efd8d7 41
mbed_tw_hoehoe 0:83b5c6efd8d7 42 void serviceDiscoveryCallback(const DiscoveredService *service) {
hmiot 6:71e7a446ae6a 43 pc.printf("Service Discovery Callback\r\n");
hmiot 6:71e7a446ae6a 44 if (service->getUUID().shortOrLong() == UUID::UUID_TYPE_SHORT) {
hmiot 6:71e7a446ae6a 45 pc.printf("S UUID-%x attrs[%u %u]\r\n", service->getUUID().getShortUUID(), service->getStartHandle(), service->getEndHandle());
hmiot 6:71e7a446ae6a 46 } else {
hmiot 6:71e7a446ae6a 47 pc.printf("S UUID-");
hmiot 6:71e7a446ae6a 48 const uint8_t *longUUIDBytes = service->getUUID().getBaseUUID();
hmiot 6:71e7a446ae6a 49 for (unsigned i = 0; i < UUID::LENGTH_OF_LONG_UUID; i++) {
hmiot 6:71e7a446ae6a 50 printf("%02x", longUUIDBytes[i]);
hmiot 6:71e7a446ae6a 51 }
hmiot 6:71e7a446ae6a 52 pc.printf(" attrs[%u %u]\r\n", service->getStartHandle(), service->getEndHandle());
hmiot 6:71e7a446ae6a 53 }
mbed_tw_hoehoe 0:83b5c6efd8d7 54 }
mbed_tw_hoehoe 0:83b5c6efd8d7 55
mbed_tw_hoehoe 0:83b5c6efd8d7 56 void characteristicDiscoveryCallback(const DiscoveredCharacteristic *characteristicP) {
hmiot 6:71e7a446ae6a 57 pc.printf(" C UUID-%x valueAttr[%u] props[%x]\r\n", characteristicP->getUUID().getShortUUID(), characteristicP->getValueHandle(), (uint8_t)characteristicP->getProperties().broadcast());
hmiot 8:285ebd0e83fb 58
hmiot 9:b967a01810e1 59 if (characteristicP->getUUID().getShortUUID() == 0xffe9) { /* !ALERT! Alter this filter to suit your device. */
hmiot 8:285ebd0e83fb 60 lightCharacteristic = *characteristicP;
hmiot 6:71e7a446ae6a 61 pc.printf("Matched char UUID\r\n");
hmiot 8:285ebd0e83fb 62 printf("Conn Handle = %dand %d \r\n",characteristicP->getConnectionHandle(), lightCharacteristic.getConnectionHandle());
hmiot 8:285ebd0e83fb 63 printf("Value Handle = %d and %d\r\n",characteristicP->getValueHandle(),lightCharacteristic.getValueHandle());
hmiot 10:5e5fa5bf77b5 64 AddCharNodes(lightCharacteristic);
hmiot 9:b967a01810e1 65 charDiscover = 1;
hmiot 9:b967a01810e1 66 serviceDiscover = true;
hmiot 9:b967a01810e1 67 }else {
hmiot 8:285ebd0e83fb 68 printf("Not Matched char UUID\r\n");
mbed_tw_hoehoe 2:4b53d13d9851 69 }
mbed_tw_hoehoe 0:83b5c6efd8d7 70 }
mbed_tw_hoehoe 0:83b5c6efd8d7 71
hmiot 8:285ebd0e83fb 72 void AddCharNodes(DiscoveredCharacteristic light_Characteristic)
hmiot 8:285ebd0e83fb 73 {
hmiot 8:285ebd0e83fb 74 printf("Add Char Nodes\r\n");
hmiot 8:285ebd0e83fb 75 lightCharacteristic_t *ptr_temp_char = NULL;
hmiot 8:285ebd0e83fb 76 ptr_temp_char = lightChar.services_Char[0];
hmiot 8:285ebd0e83fb 77
hmiot 8:285ebd0e83fb 78 if(NULL == ptr_temp_char)
hmiot 8:285ebd0e83fb 79 {
hmiot 8:285ebd0e83fb 80 ptr_temp_char = (lightCharacteristic_t *)malloc(sizeof(lightCharacteristic_t));
hmiot 8:285ebd0e83fb 81 lightChar.services_Char[0] = ptr_temp_char;
hmiot 8:285ebd0e83fb 82 }
hmiot 8:285ebd0e83fb 83 else
hmiot 8:285ebd0e83fb 84 {
hmiot 8:285ebd0e83fb 85 while(NULL != ptr_temp_char->nextChar)
hmiot 8:285ebd0e83fb 86 {
hmiot 8:285ebd0e83fb 87 ptr_temp_char = ptr_temp_char->nextChar;
hmiot 8:285ebd0e83fb 88 }
hmiot 8:285ebd0e83fb 89
hmiot 8:285ebd0e83fb 90 /* add a new node */
hmiot 8:285ebd0e83fb 91 ptr_temp_char->nextChar = (lightCharacteristic_t *)malloc(sizeof(lightCharacteristic_t));
hmiot 8:285ebd0e83fb 92 ptr_temp_char = ptr_temp_char->nextChar;
hmiot 8:285ebd0e83fb 93 }
hmiot 8:285ebd0e83fb 94
hmiot 8:285ebd0e83fb 95 /* assign data to the node */
hmiot 8:285ebd0e83fb 96 ptr_temp_char->u_characteristicID = 1;
hmiot 8:285ebd0e83fb 97 printf("Conn Handle = %d\r\n",light_Characteristic.getConnectionHandle());
hmiot 8:285ebd0e83fb 98 printf("Value Handle = %d\r\n",light_Characteristic.getValueHandle());
hmiot 8:285ebd0e83fb 99 ptr_temp_char->connHandle = light_Characteristic.getConnectionHandle();
hmiot 8:285ebd0e83fb 100 ptr_temp_char->valueHandle = light_Characteristic.getValueHandle();
hmiot 8:285ebd0e83fb 101 ptr_temp_char->nextChar = NULL;
hmiot 8:285ebd0e83fb 102 }
hmiot 8:285ebd0e83fb 103
mbed_tw_hoehoe 0:83b5c6efd8d7 104 void discoveryTerminationCallback(Gap::Handle_t connectionHandle) {
mbed_tw_hoehoe 1:2f1203d70643 105 pc.printf("terminated SD for handle %u\r\n", connectionHandle);
hmiot 8:285ebd0e83fb 106 serviceDiscover = false;
mbed_tw_hoehoe 0:83b5c6efd8d7 107 }
mbed_tw_hoehoe 0:83b5c6efd8d7 108
hmiot 6:71e7a446ae6a 109 void connectionCallback(const Gap::ConnectionCallbackParams_t *params) {
hmiot 6:71e7a446ae6a 110 pc.printf("Connection Callback\n\r");
hmiot 6:71e7a446ae6a 111 if (params->role == Gap::CENTRAL) {
hmiot 6:71e7a446ae6a 112 pc.printf("Service and characterstics discovery callback\r\n");
hmiot 6:71e7a446ae6a 113 BLE::Instance().gattClient().onServiceDiscoveryTermination(discoveryTerminationCallback);
hmiot 6:71e7a446ae6a 114 BLE::Instance().gattClient().launchServiceDiscovery(params->handle, serviceDiscoveryCallback, characteristicDiscoveryCallback, 0xffe5, 0xffe9);
hmiot 10:5e5fa5bf77b5 115 // 0xffe5 --> Services UUID
hmiot 10:5e5fa5bf77b5 116 // 0xffe9 --> Characteristics UUID
mbed_tw_hoehoe 0:83b5c6efd8d7 117 }
hmiot 6:71e7a446ae6a 118 }
hmiot 6:71e7a446ae6a 119
hmiot 6:71e7a446ae6a 120 void disconnectionCallback(const Gap::DisconnectionCallbackParams_t *params) {
hmiot 6:71e7a446ae6a 121 pc.printf("disconnected\r\n");
hmiot 8:285ebd0e83fb 122 BLE::Instance().gap().startScan(advertisementCallback);
mbed_tw_hoehoe 0:83b5c6efd8d7 123 }
mbed_tw_hoehoe 0:83b5c6efd8d7 124
hmiot 6:71e7a446ae6a 125
hmiot 6:71e7a446ae6a 126 /**
hmiot 6:71e7a446ae6a 127 * Callback triggered when the ble initialization process has finished
hmiot 6:71e7a446ae6a 128 */
hmiot 6:71e7a446ae6a 129 void bleInitComplete(BLE::InitializationCompleteCallbackContext *params)
hmiot 6:71e7a446ae6a 130 {
hmiot 6:71e7a446ae6a 131 BLE& ble = params->ble;
hmiot 8:285ebd0e83fb 132
hmiot 6:71e7a446ae6a 133 pc.printf("Ble Init\n\r");
hmiot 9:b967a01810e1 134 /* Ensure that it is the default instance of BLE */
hmiot 6:71e7a446ae6a 135 if(ble.getInstanceID() != BLE::DEFAULT_INSTANCE) {
hmiot 6:71e7a446ae6a 136 return;
hmiot 9:b967a01810e1 137 }
hmiot 6:71e7a446ae6a 138
hmiot 9:b967a01810e1 139 ble.gap().onConnection(connectionCallback);
hmiot 9:b967a01810e1 140 ble.gap().onDisconnection(disconnectionCallback);
hmiot 9:b967a01810e1 141 ble.gap().setScanParams(1000, 800);
hmiot 9:b967a01810e1 142 ble.gap().startScan(advertisementCallback);
hmiot 10:5e5fa5bf77b5 143
hmiot 8:285ebd0e83fb 144 }
hmiot 8:285ebd0e83fb 145
hmiot 8:285ebd0e83fb 146 void light_actions(int service_char[]){
hmiot 10:5e5fa5bf77b5 147 write_data = new uint8_t[8];
hmiot 8:285ebd0e83fb 148 lightCharacteristic_t *ptr_tmp = NULL;
hmiot 9:b967a01810e1 149 ptr_tmp = lightChar.services_Char[service_char[1]-1];
hmiot 10:5e5fa5bf77b5 150 if(connect_status)
hmiot 10:5e5fa5bf77b5 151 {
hmiot 9:b967a01810e1 152
hmiot 10:5e5fa5bf77b5 153 switch(service_char[2])
hmiot 10:5e5fa5bf77b5 154 {
hmiot 10:5e5fa5bf77b5 155 case TURN_OFF: // off
hmiot 10:5e5fa5bf77b5 156 write_data[0]=0x56;
hmiot 10:5e5fa5bf77b5 157 write_data[1]=0x00;
hmiot 10:5e5fa5bf77b5 158 write_data[2]=0x00;
hmiot 10:5e5fa5bf77b5 159 write_data[3]=0x00;
hmiot 10:5e5fa5bf77b5 160 write_data[4]=0x00;
hmiot 10:5e5fa5bf77b5 161 write_data[5]=0xf0;
hmiot 10:5e5fa5bf77b5 162 write_data[6]=0xaa;
hmiot 10:5e5fa5bf77b5 163 error_status = BLE::Instance().gattClient().write(GattClient::GATT_OP_WRITE_CMD,ptr_tmp->connHandle,ptr_tmp->valueHandle,8,write_data);
hmiot 10:5e5fa5bf77b5 164 break;
hmiot 8:285ebd0e83fb 165
hmiot 10:5e5fa5bf77b5 166 case TURN_ON: //on
hmiot 10:5e5fa5bf77b5 167 if(first_on){
hmiot 10:5e5fa5bf77b5 168 pre_write_data[0]=0x56;
hmiot 10:5e5fa5bf77b5 169 pre_write_data[1]=0xDE;
hmiot 10:5e5fa5bf77b5 170 pre_write_data[2]=0x8E;
hmiot 10:5e5fa5bf77b5 171 pre_write_data[3]=0xEE;
hmiot 10:5e5fa5bf77b5 172 pre_write_data[4]=0x00;
hmiot 10:5e5fa5bf77b5 173 pre_write_data[5]=0xf0;
hmiot 10:5e5fa5bf77b5 174 pre_write_data[6]=0xaa;
hmiot 10:5e5fa5bf77b5 175 }
hmiot 10:5e5fa5bf77b5 176 error_status = BLE::Instance().gattClient().write(GattClient::GATT_OP_WRITE_CMD,ptr_tmp->connHandle,ptr_tmp->valueHandle,8,pre_write_data);
hmiot 10:5e5fa5bf77b5 177 break;
hmiot 8:285ebd0e83fb 178
hmiot 10:5e5fa5bf77b5 179 case COLOR: // Color
hmiot 10:5e5fa5bf77b5 180 write_data[0]=0x56;
hmiot 10:5e5fa5bf77b5 181 write_data[1]=lightColor[service_char[3]][0];//0xff
hmiot 10:5e5fa5bf77b5 182 write_data[2]=lightColor[service_char[3]][1];//0x00;
hmiot 10:5e5fa5bf77b5 183 write_data[3]=lightColor[service_char[3]][2];//0x00;
hmiot 10:5e5fa5bf77b5 184 write_data[4]=0x00;
hmiot 10:5e5fa5bf77b5 185 write_data[5]=0xf0;
hmiot 10:5e5fa5bf77b5 186 write_data[6]=0xaa;
hmiot 10:5e5fa5bf77b5 187 datancpy((char *)pre_write_data, (char *)write_data,6);
hmiot 10:5e5fa5bf77b5 188 first_on=false;
hmiot 10:5e5fa5bf77b5 189 error_status = BLE::Instance().gattClient().write(GattClient::GATT_OP_WRITE_CMD,ptr_tmp->connHandle,ptr_tmp->valueHandle,8,write_data);
hmiot 10:5e5fa5bf77b5 190 break;
hmiot 8:285ebd0e83fb 191
hmiot 10:5e5fa5bf77b5 192 default:
hmiot 10:5e5fa5bf77b5 193 printf("Invalid Options\r\n");
hmiot 10:5e5fa5bf77b5 194 }
hmiot 10:5e5fa5bf77b5 195 printf("Error Status =%d\n\r",error_status);
hmiot 10:5e5fa5bf77b5 196 delete [] write_data;
hmiot 10:5e5fa5bf77b5 197 }
hmiot 8:285ebd0e83fb 198 }
hmiot 8:285ebd0e83fb 199
hmiot 8:285ebd0e83fb 200 void datancpy(char *pre_write, char *writeData, int data_size){
hmiot 8:285ebd0e83fb 201 int numCount;
hmiot 8:285ebd0e83fb 202 for(numCount=0; numCount <= data_size; numCount++){
hmiot 8:285ebd0e83fb 203 pre_write[numCount] = writeData[numCount];
hmiot 8:285ebd0e83fb 204 }
hmiot 8:285ebd0e83fb 205
mbed_tw_hoehoe 2:4b53d13d9851 206 }
mbed_tw_hoehoe 2:4b53d13d9851 207
hmiot 8:285ebd0e83fb 208 void bleint()
hmiot 8:285ebd0e83fb 209 {
hmiot 8:285ebd0e83fb 210 printf("Init\r\n");
hmiot 9:b967a01810e1 211 BLE &ble = BLE::Instance();
hmiot 8:285ebd0e83fb 212 BLE::Instance().init(bleInitComplete);
hmiot 8:285ebd0e83fb 213 }
hmiot 8:285ebd0e83fb 214
hmiot 8:285ebd0e83fb 215 int main()
hmiot 8:285ebd0e83fb 216 {
hmiot 8:285ebd0e83fb 217 // Serial port configuration
mbed_tw_hoehoe 1:2f1203d70643 218 pc.baud(9600);
mbed_tw_hoehoe 0:83b5c6efd8d7 219 wait(8.0);
hmiot 9:b967a01810e1 220 pc.printf("Start\n\r");
hmiot 10:5e5fa5bf77b5 221 // int options;
hmiot 8:285ebd0e83fb 222 spiSlave.reply(191);
hmiot 9:b967a01810e1 223 bleint();
hmiot 10:5e5fa5bf77b5 224 bufferSize = 0;
hmiot 10:5e5fa5bf77b5 225 while(1){
hmiot 9:b967a01810e1 226 //printf("loop\r\n");
hmiot 10:5e5fa5bf77b5 227 if(!(connect_status && charDiscover))
hmiot 10:5e5fa5bf77b5 228 waitBleEvent();
hmiot 10:5e5fa5bf77b5 229
hmiot 10:5e5fa5bf77b5 230 if(spiSlave.receive()){
hmiot 10:5e5fa5bf77b5 231 // printf("Slave Read loop1\r\n");
hmiot 10:5e5fa5bf77b5 232 spiRX[bufferSize] = spiSlave.read();
hmiot 10:5e5fa5bf77b5 233 spiSlave.reply(spiRX[bufferSize]);
hmiot 10:5e5fa5bf77b5 234 bufferSize++;
hmiot 10:5e5fa5bf77b5 235
hmiot 10:5e5fa5bf77b5 236 if(bufferSize >= 5){
hmiot 10:5e5fa5bf77b5 237 bufferSize=0;
hmiot 10:5e5fa5bf77b5 238 light_actions(spiRX);
hmiot 10:5e5fa5bf77b5 239 spiSlave.reply(0xAA);
hmiot 10:5e5fa5bf77b5 240 }
hmiot 10:5e5fa5bf77b5 241
hmiot 8:285ebd0e83fb 242 }
hmiot 10:5e5fa5bf77b5 243
hmiot 10:5e5fa5bf77b5 244 wait_us(15);
hmiot 9:b967a01810e1 245 }
hmiot 9:b967a01810e1 246
hmiot 9:b967a01810e1 247 }
hmiot 9:b967a01810e1 248
hmiot 10:5e5fa5bf77b5 249 void waitBleEvent()
hmiot 10:5e5fa5bf77b5 250 {
hmiot 10:5e5fa5bf77b5 251 while(serviceDiscover || BLE::Instance().gattClient().isServiceDiscoveryActive()){
hmiot 10:5e5fa5bf77b5 252 BLE::Instance().waitForEvent();
hmiot 10:5e5fa5bf77b5 253 }
hmiot 9:b967a01810e1 254 }
hmiot 10:5e5fa5bf77b5 255