Desmond Chen
/
mbed-os-example-ble-BatteryLevel_copy_copy
copy2
Diff: source/main.cpp
- Revision:
- 76:e489712bcbcf
- Parent:
- 46:6b66d08f304e
--- a/source/main.cpp Fri Dec 14 13:15:11 2018 +0000 +++ b/source/main.cpp Mon Jan 14 10:45:14 2019 +0000 @@ -19,111 +19,139 @@ #include "ble/BLE.h" #include "ble/Gap.h" #include "ble/services/BatteryService.h" +#include "pretty_printer.h" -DigitalOut led1(LED1, 1); +static DigitalOut led1(LED1, 1); + +const static char DEVICE_NAME[] = "BATTERY"; + +static events::EventQueue event_queue(/* event count */ 16 * EVENTS_EVENT_SIZE); -const static char DEVICE_NAME[] = "BATTERY"; -static const uint16_t uuid16_list[] = {GattService::UUID_BATTERY_SERVICE}; - -static uint8_t batteryLevel = 50; -static BatteryService* batteryServicePtr; +class BatteryDemo : ble::Gap::EventHandler { +public: + BatteryDemo(BLE &ble, events::EventQueue &event_queue) : + _ble(ble), + _event_queue(event_queue), + _battery_uuid(GattService::UUID_BATTERY_SERVICE), + _battery_level(50), + _battery_service(ble, _battery_level), + _adv_data_builder(_adv_buffer) { } -static EventQueue eventQueue(/* event count */ 16 * EVENTS_EVENT_SIZE); + void start() { + _ble.gap().setEventHandler(this); + + _ble.init(this, &BatteryDemo::on_init_complete); + + _event_queue.call_every(500, this, &BatteryDemo::blink); + _event_queue.call_every(1000, this, &BatteryDemo::update_sensor_value); + + _event_queue.dispatch_forever(); + } -void disconnectionCallback(const Gap::DisconnectionCallbackParams_t *params) -{ - BLE::Instance().gap().startAdvertising(); -} +private: + /** Callback triggered when the ble initialization process has finished */ + void on_init_complete(BLE::InitializationCompleteCallbackContext *params) { + if (params->error != BLE_ERROR_NONE) { + print_error(params->error, "Ble initialization failed."); + return; + } -void updateSensorValue() { - batteryLevel++; - if (batteryLevel > 100) { - batteryLevel = 20; + print_mac_address(); + + start_advertising(); } - batteryServicePtr->updateBatteryLevel(batteryLevel); -} + void start_advertising() { + /* Create advertising parameters and payload */ -void blinkCallback(void) -{ - led1 = !led1; /* Do blinky on LED1 while we're waiting for BLE events */ + ble::AdvertisingParameters adv_parameters( + ble::advertising_type_t::CONNECTABLE_UNDIRECTED, + ble::adv_interval_t(ble::millisecond_t(1000)) + ); - BLE &ble = BLE::Instance(); - if (ble.gap().getState().connected) { - eventQueue.call(updateSensorValue); - } -} + _adv_data_builder.setFlags(); + _adv_data_builder.setLocalServiceList(mbed::make_Span(&_battery_uuid, 1)); + _adv_data_builder.setName(DEVICE_NAME); -/** - * This function is called when the ble initialization process has failled - */ -void onBleInitError(BLE &ble, ble_error_t error) -{ - /* Initialization error handling should go here */ -} + /* Setup advertising */ + + ble_error_t error = _ble.gap().setAdvertisingParameters( + ble::LEGACY_ADVERTISING_HANDLE, + adv_parameters + ); -void printMacAddress() -{ - /* Print out device MAC address to the console*/ - Gap::AddressType_t addr_type; - Gap::Address_t address; - BLE::Instance().gap().getAddress(&addr_type, address); - printf("DEVICE MAC ADDRESS: "); - for (int i = 5; i >= 1; i--){ - printf("%02x:", address[i]); - } - printf("%02x\r\n", address[0]); -} + if (error) { + print_error(error, "_ble.gap().setAdvertisingParameters() failed"); + return; + } + + error = _ble.gap().setAdvertisingPayload( + ble::LEGACY_ADVERTISING_HANDLE, + _adv_data_builder.getAdvertisingData() + ); -/** - * Callback triggered when the ble initialization process has finished - */ -void bleInitComplete(BLE::InitializationCompleteCallbackContext *params) -{ - BLE& ble = params->ble; - ble_error_t error = params->error; + if (error) { + print_error(error, "_ble.gap().setAdvertisingPayload() failed"); + return; + } + + /* Start advertising */ - if (error != BLE_ERROR_NONE) { - /* In case of error, forward the error handling to onBleInitError */ - onBleInitError(ble, error); - return; + error = _ble.gap().startAdvertising(ble::LEGACY_ADVERTISING_HANDLE); + + if (error) { + print_error(error, "_ble.gap().startAdvertising() failed"); + return; + } } - /* Ensure that it is the default instance of BLE */ - if(ble.getInstanceID() != BLE::DEFAULT_INSTANCE) { - return; + void update_sensor_value() { + if (_ble.gap().getState().connected) { + _battery_level++; + if (_battery_level > 100) { + _battery_level = 20; + } + + _battery_service.updateBatteryLevel(_battery_level); + } + } + + void blink(void) { + led1 = !led1; } - ble.gap().onDisconnection(disconnectionCallback); +private: + /* Event handler */ - /* Setup primary service */ - batteryServicePtr = new BatteryService(ble, batteryLevel); + void onDisconnectionComplete(const ble::DisconnectionCompleteEvent&) { + _ble.gap().startAdvertising(ble::LEGACY_ADVERTISING_HANDLE); + } + +private: + BLE &_ble; + events::EventQueue &_event_queue; - /* Setup advertising */ - ble.gap().accumulateAdvertisingPayload(GapAdvertisingData::BREDR_NOT_SUPPORTED | GapAdvertisingData::LE_GENERAL_DISCOVERABLE); - ble.gap().accumulateAdvertisingPayload(GapAdvertisingData::COMPLETE_LIST_16BIT_SERVICE_IDS, (uint8_t *) uuid16_list, sizeof(uuid16_list)); - ble.gap().accumulateAdvertisingPayload(GapAdvertisingData::COMPLETE_LOCAL_NAME, (uint8_t *) DEVICE_NAME, sizeof(DEVICE_NAME)); - ble.gap().setAdvertisingType(GapAdvertisingParams::ADV_CONNECTABLE_UNDIRECTED); - ble.gap().setAdvertisingInterval(1000); /* 1000ms */ - ble.gap().startAdvertising(); + UUID _battery_uuid; + + uint8_t _battery_level; + BatteryService _battery_service; - printMacAddress(); -} + uint8_t _adv_buffer[ble::LEGACY_ADVERTISING_MAX_SIZE]; + ble::AdvertisingDataBuilder _adv_data_builder; +}; -void scheduleBleEventsProcessing(BLE::OnEventsToProcessCallbackContext* context) { - BLE &ble = BLE::Instance(); - eventQueue.call(Callback<void()>(&ble, &BLE::processEvents)); +/** Schedule processing of events from the BLE middleware in the event queue. */ +void schedule_ble_events(BLE::OnEventsToProcessCallbackContext *context) { + event_queue.call(Callback<void()>(&context->ble, &BLE::processEvents)); } int main() { - eventQueue.call_every(500, blinkCallback); + BLE &ble = BLE::Instance(); + ble.onEventsToProcess(schedule_ble_events); - BLE &ble = BLE::Instance(); - ble.onEventsToProcess(scheduleBleEventsProcessing); - ble.init(bleInitComplete); - - eventQueue.dispatch_forever(); + BatteryDemo demo(ble, event_queue); + demo.start(); return 0; }