Dung Nguyen / Mbed 2 deprecated TimeSync

for camera

Dependencies:   BLE_API mbed nRF51822

Fork of BLE_GATT_Example by Bluetooth Low Energy

main.cpp@23:8cd0bcd06533, 2017-06-06 (annotated)

Committer:
andreydung
Date:
Tue Jun 06 00:15:32 2017 +0000
Revision:
23:8cd0bcd06533
Parent:
22:406127954d1f
Child:
24:64e7d23021ba
timesync with look up table

Who changed what in which revision?

UserRevisionLine numberNew contents of line
mbedAustin 0:cd5b6733aeb1 1 #include "mbed.h"
andresag 19:477567297aac 2 #include "ble/BLE.h"
mbedAustin 1:94152e7d8b5c 3
andresag 19:477567297aac 4 DigitalOut led(LED1, 1);
mbedAustin 9:b33f42191584 5 uint16_t customServiceUUID = 0xA000;
mbedAustin 13:62b1d32745ac 6 uint16_t readCharUUID = 0xA001;
mbedAustin 9:b33f42191584 7 uint16_t writeCharUUID = 0xA002;
mbedAustin 1:94152e7d8b5c 8
andreydung 23:8cd0bcd06533 9 const uint8_t lookUpTable[6][5] = { {1,0,0,0,1},
andreydung 23:8cd0bcd06533 10 {1,0,0,1,1},
andreydung 23:8cd0bcd06533 11 {1,1,0,0,1},
andreydung 23:8cd0bcd06533 12 {1,0,1,0,1},
andreydung 23:8cd0bcd06533 13 {1,1,0,1,1}};
andreydung 23:8cd0bcd06533 14
andreydung 23:8cd0bcd06533 15 const static char DEVICE_NAME[] = "timesync1"; // change this
mbedAustin 8:60ede963dfe2 16 static const uint16_t uuid16_list[] = {0xFFFF}; //Custom UUID, FFFF is reserved for development
mbedAustin 1:94152e7d8b5c 17
andresag 22:406127954d1f 18 /* Set Up custom Characteristics */
mbedAustin 9:b33f42191584 19 static uint8_t readValue[10] = {0};
mbedAustin 12:6d1f77d0cb37 20 ReadOnlyArrayGattCharacteristic<uint8_t, sizeof(readValue)> readChar(readCharUUID, readValue);
mbedAustin 2:e84c13abc479 21
mbedAustin 9:b33f42191584 22 static uint8_t writeValue[10] = {0};
mbedAustin 12:6d1f77d0cb37 23 WriteOnlyArrayGattCharacteristic<uint8_t, sizeof(writeValue)> writeChar(writeCharUUID, writeValue);
mbedAustin 2:e84c13abc479 24
andresag 22:406127954d1f 25 /* Set up custom service */
mbedAustin 8:60ede963dfe2 26 GattCharacteristic *characteristics[] = {&readChar, &writeChar};
mbedAustin 9:b33f42191584 27 GattService customService(customServiceUUID, characteristics, sizeof(characteristics) / sizeof(GattCharacteristic *));
mbedAustin 2:e84c13abc479 28
mbedAustin 2:e84c13abc479 29
mbedAustin 8:60ede963dfe2 30 /*
mbedAustin 8:60ede963dfe2 31 * Restart advertising when phone app disconnects
andresag 19:477567297aac 32 */
andresag 19:477567297aac 33 void disconnectionCallback(const Gap::DisconnectionCallbackParams_t *)
mbedAustin 1:94152e7d8b5c 34 {
andresag 22:406127954d1f 35 BLE::Instance(BLE::DEFAULT_INSTANCE).gap().startAdvertising();
mbedAustin 1:94152e7d8b5c 36 }
mbedAustin 0:cd5b6733aeb1 37
andresag 19:477567297aac 38 /*
andresag 22:406127954d1f 39 * Handle writes to writeCharacteristic
mbedAustin 8:60ede963dfe2 40 */
melmon 18:7d89c4fba362 41 void writeCharCallback(const GattWriteCallbackParams *params)
mbedAustin 3:0fb60f81f693 42 {
andresag 22:406127954d1f 43 /* Check to see what characteristic was written, by handle */
melmon 18:7d89c4fba362 44 if(params->handle == writeChar.getValueHandle()) {
andresag 22:406127954d1f 45 /* toggle LED if only 1 byte is written */
mbedAustin 8:60ede963dfe2 46 if(params->len == 1) {
mbedAustin 8:60ede963dfe2 47 led = params->data[0];
andresag 19:477567297aac 48 (params->data[0] == 0x00) ? printf("led on\n\r") : printf("led off\n\r"); // print led toggle
mbedAustin 8:60ede963dfe2 49 }
andresag 22:406127954d1f 50 /* Print the data if more than 1 byte is written */
mbedAustin 8:60ede963dfe2 51 else {
andresag 19:477567297aac 52 printf("Data received: length = %d, data = 0x",params->len);
mbedAustin 8:60ede963dfe2 53 for(int x=0; x < params->len; x++) {
andresag 19:477567297aac 54 printf("%x", params->data[x]);
mbedAustin 8:60ede963dfe2 55 }
andresag 19:477567297aac 56 printf("\n\r");
mbedAustin 8:60ede963dfe2 57 }
andresag 22:406127954d1f 58 /* Update the readChar with the value of writeChar */
andresag 22:406127954d1f 59 BLE::Instance(BLE::DEFAULT_INSTANCE).gattServer().write(readChar.getValueHandle(), params->data, params->len);
mbedAustin 8:60ede963dfe2 60 }
mbedAustin 3:0fb60f81f693 61 }
andresag 22:406127954d1f 62 /*
andresag 22:406127954d1f 63 * Initialization callback
andresag 22:406127954d1f 64 */
andresag 22:406127954d1f 65 void bleInitComplete(BLE::InitializationCompleteCallbackContext *params)
andresag 22:406127954d1f 66 {
andresag 22:406127954d1f 67 BLE &ble = params->ble;
andresag 22:406127954d1f 68 ble_error_t error = params->error;
andresag 22:406127954d1f 69
andresag 22:406127954d1f 70 if (error != BLE_ERROR_NONE) {
andresag 22:406127954d1f 71 return;
andresag 22:406127954d1f 72 }
mbedAustin 0:cd5b6733aeb1 73
andresag 19:477567297aac 74 ble.gap().onDisconnection(disconnectionCallback);
andresag 19:477567297aac 75 ble.gattServer().onDataWritten(writeCharCallback);
mbedAustin 2:e84c13abc479 76
andresag 22:406127954d1f 77 /* Setup advertising */
andresag 19:477567297aac 78 ble.gap().accumulateAdvertisingPayload(GapAdvertisingData::BREDR_NOT_SUPPORTED | GapAdvertisingData::LE_GENERAL_DISCOVERABLE); // BLE only, no classic BT
andresag 19:477567297aac 79 ble.gap().setAdvertisingType(GapAdvertisingParams::ADV_CONNECTABLE_UNDIRECTED); // advertising type
andresag 19:477567297aac 80 ble.gap().accumulateAdvertisingPayload(GapAdvertisingData::COMPLETE_LOCAL_NAME, (uint8_t *)DEVICE_NAME, sizeof(DEVICE_NAME)); // add name
andresag 19:477567297aac 81 ble.gap().accumulateAdvertisingPayload(GapAdvertisingData::COMPLETE_LIST_16BIT_SERVICE_IDS, (uint8_t *)uuid16_list, sizeof(uuid16_list)); // UUID's broadcast in advertising packet
andresag 19:477567297aac 82 ble.gap().setAdvertisingInterval(100); // 100ms.
mbedAustin 2:e84c13abc479 83
andresag 22:406127954d1f 84 /* Add our custom service */
mbedAustin 13:62b1d32745ac 85 ble.addService(customService);
mbedAustin 2:e84c13abc479 86
andresag 22:406127954d1f 87 /* Start advertising */
andresag 19:477567297aac 88 ble.gap().startAdvertising();
andresag 22:406127954d1f 89 }
andresag 19:477567297aac 90
andresag 22:406127954d1f 91 /*
andresag 22:406127954d1f 92 * Main loop
andresag 22:406127954d1f 93 */
andresag 22:406127954d1f 94 int main(void)
andresag 22:406127954d1f 95 {
andresag 22:406127954d1f 96 /* initialize stuff */
andresag 22:406127954d1f 97 printf("\n\r********* Starting Main Loop *********\n\r");
andresag 22:406127954d1f 98
andresag 22:406127954d1f 99 BLE& ble = BLE::Instance(BLE::DEFAULT_INSTANCE);
andresag 22:406127954d1f 100 ble.init(bleInitComplete);
andresag 22:406127954d1f 101
andresag 22:406127954d1f 102 /* SpinWait for initialization to complete. This is necessary because the
andresag 22:406127954d1f 103 * BLE object is used in the main loop below. */
andresag 22:406127954d1f 104 while (ble.hasInitialized() == false) { /* spin loop */ }
andresag 22:406127954d1f 105
andresag 22:406127954d1f 106 /* Infinite loop waiting for BLE interrupt events */
mbedAustin 2:e84c13abc479 107 while (true) {
andresag 22:406127954d1f 108 ble.waitForEvent(); /* Save power */
mbedAustin 2:e84c13abc479 109 }
andresag 20:fcc752d401ec 110 }