init
Dependencies: BLE_API mbed nRF51822
Diff: main.cpp
- Revision:
- 0:84779d0d1ff5
- Child:
- 1:4bdebb81dcd5
--- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/main.cpp Tue Jul 21 08:39:03 2015 +0000 @@ -0,0 +1,191 @@ +/* mbed Microcontroller Library + * Copyright (c) 2006-2015 ARM Limited + * + * Licensed under the Apache License, Version 2.0 (the "License"); + * you may not use this file except in compliance with the License. + * You may obtain a copy of the License at + * + * http://www.apache.org/licenses/LICENSE-2.0 + * + * Unless required by applicable law or agreed to in writing, software + * distributed under the License is distributed on an "AS IS" BASIS, + * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. + * See the License for the specific language governing permissions and + * limitations under the License. + */ + +#include "mbed.h" +#include "ble/BLE.h" +#include "ble/services/HeartRateService.h" +#include "ble/services/BatteryService.h" +#include "ble/services/DeviceInformationService.h" +#include "LEDService.h" + +#define BLE_CHECK(X) (X == BLE_ERROR_NONE) ? (printf("{{success}}\r\n")) : printf("{{failure}} %s at line %u ERROR CODE: %u\r\n", #X, __LINE__, (X)); +#define BLE_EQUAL(X,Y) ((X)==(Y)) ? (printf("{{sucess}}\n")) : printf("{{failure}}\n"); + +BLE ble; +DigitalOut led1(LED1); +Gap::Address_t address; +Gap::AddressType_t *addressType; + +const static char DEVICE_NAME[] = "HRMTEST"; +static const uint16_t uuid16_list[] = {GattService::UUID_HEART_RATE_SERVICE, + GattService::UUID_DEVICE_INFORMATION_SERVICE}; +static volatile bool triggerSensorPolling = false; + +void disconnectionCallback(Gap::Handle_t handle, Gap::DisconnectionReason_t reason) +{ + ble.gap().startAdvertising(); // restart advertising +} + +void periodicCallback(void) +{ + led1 = !led1; /* Do blinky on LED1 while we're waiting for BLE events */ + + /* Note that the periodicCallback() executes in interrupt context, so it is safer to do + * heavy-weight sensor polling from the main thread. */ + if (ble.getGapState().connected){ + hrmCounter++; + // 100 <= HRM bps <=175 + if (hrmCounter == 175) { + hrmCounter = 100; + } + // update bps + hrService.updateHeartRate(hrmCounter); + } +} + +void connectionCallback(const Gap::ConnectionCallbackParams_t *params){ + printf("Connected to: %d:%d:%d:%d:%d:%d\n", params->peerAddr[0], params->peerAddr[1], params->peerAddr[2], params->peerAddr[3], params->peerAddr[4], params->peerAddr[5]); + +} + +void dataReadCallback(const GattReadCallbackParams *params){ + printf("%d\n", params->data[1]); +} + +void testDeviceName(){ + uint8_t deviceName[10]; + uint8_t deviceNameIn[] = {0x4A, 0x4F, 0x53, 0x48, 0x54, 0x45, 0x53, 0x54, 0x00}; + unsigned length = 10; + BLE_CHECK(ble.gap().setDeviceName(deviceNameIn)); + BLE_CHECK(ble.gap().getDeviceName(deviceName, &length)); + for (int i = 0; i < length; i++){ + printf("%02x ", deviceName[i]); + } + printf("\r\n"); + for (int i = 0; i < 8; i++){ + printf("%02x ", deviceNameIn[i]); + } + printf("\r\n"); +} + +void testAppearance(){ + GapAdvertisingData::Appearance appearance; + BLE_CHECK(ble.gap().setAppearance(GapAdvertisingData::GENERIC_PHONE)); + BLE_CHECK(ble.gap().getAppearance(&appearance)); + printf("%d\r\n",appearance); +} + +void connParams(){ + Gap::ConnectionParams_t params; + Gap::ConnectionParams_t paramsOut = {50,500,0,500}; + Gap::ConnectionParams_t temp; + BLE_CHECK(ble.gap().getPreferredConnectionParams(&temp)); + BLE_CHECK(ble.gap().setPreferredConnectionParams(¶msOut)); + ble.gap().getPreferredConnectionParams(¶ms); + printf("%d\n", params.minConnectionInterval); + printf("%d\n", params.maxConnectionInterval); + printf("%d\n", params.slaveLatency); + printf("%d\n", params.connectionSupervisionTimeout); + ble.gap().setPreferredConnectionParams(&temp); + +} + +void testcentre(void){ + + scanf("%d", &x); + testDeviceName(); + scanf("%d", &x); + testAppearance(); + scanf("%d", &x); + connParams(); + int x; + while(1){ + scanf("%d", &x); + switch(x){ + case 0: + testDeviceName(); + break; + case 1: + testAppearance(); + break; + case 2: + connParams(); + break; + case 3: + + break; + } + } +} + +int main(void) +{ + led1 = 1; + Ticker ticker; + ticker.attach(periodicCallback, 1); // blink LED every second + + BLE_CHECK(ble.init()); + ble.gap().onDisconnection(disconnectionCallback); + ble.gap().onConnection(connectionCallback); + /* Setup primary service. */ + uint8_t hrmCounter = 100; // init HRM to 100bps + HeartRateService hrService(ble, hrmCounter, HeartRateService::LOCATION_FINGER); + + /* Setup auxiliary service. */ + DeviceInformationService deviceInfo(ble, "ARM", "Model1", "SN1", "hw-rev1", "fw-rev1", "soft-rev1"); + + /* Setup advertising. */ + BLE_CHECK(ble.gap().accumulateAdvertisingPayload(GapAdvertisingData::BREDR_NOT_SUPPORTED | GapAdvertisingData::LE_GENERAL_DISCOVERABLE)); + BLE_CHECK(ble.gap().accumulateAdvertisingPayload(GapAdvertisingData::COMPLETE_LIST_16BIT_SERVICE_IDS, (uint8_t *)uuid16_list, sizeof(uuid16_list))); + BLE_CHECK(ble.gap().accumulateAdvertisingPayload(GapAdvertisingData::GENERIC_HEART_RATE_SENSOR)); + BLE_CHECK(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_CHECK(ble.gap().startAdvertising()); + BLE_CHECK(ble.gap().getAddress(addressType, address)); + printf("{{success}}" "\n" "{{end}}" "\n"); + int x; + scanf("%d" , &x); + printf("%d:%d:%d:%d:%d:%d\n", address[0], address[1], address[2], address[3], address[4], address[5]); + testCentre(); + scanf("%d", &x); + testDeviceName(); + //printf("%d\n",ble.gattServer().onDataRead(dataReadCallback)); + scanf("%d", &x); + testAppearance(); + scanf("%d", &x); + connParams(); + // infinite loop + while (1) { + // check for trigger from periodicCallback() + if (triggerSensorPolling && ble.getGapState().connected) { + triggerSensorPolling = false; + + // Do blocking calls or whatever is necessary for sensor polling. + // In our case, we simply update the HRM measurement. + hrmCounter++; + // 100 <= HRM bps <=175 + if (hrmCounter == 175) { + hrmCounter = 100; + } + // update bps + hrService.updateHeartRate(hrmCounter); + } else { + ble.waitForEvent(); // low power wait for event + } + } +}