workss
Dependencies: mbed BLE_API nRF51822 VL53L0X
main.cpp
- Committer:
- vazbyte
- Date:
- 2019-03-13
- Revision:
- 27:903ec28ea7a0
- Parent:
- 26:793d65b08afb
- Child:
- 28:ca14866eec64
File content as of revision 27:903ec28ea7a0:
#include "mbed.h" #include "ble/BLE.h" #include "VL53L0X.h" #include "ble/services/HeartRateService.h" #define range1_addr (0x56) #define range2_addr (0x60) #define range1_XSHUT p15 #define range2_XSHUT p16 #define VL53L0_I2C_SDA p30 #define VL53L0_I2C_SCL p7 Serial pc(USBTX, USBRX); static DevI2C devI2c(VL53L0_I2C_SDA, VL53L0_I2C_SCL); DigitalOut led1(LED1); DigitalOut led2(LED2); DigitalOut led(LED3, 1); uint16_t customServiceUUID = 0xA000; uint16_t readCharUUID = 0xA001; uint16_t writeCharUUID = 0xA002; static DigitalOut shutdown1_pin(range1_XSHUT); static VL53L0X range1(&devI2c, &shutdown1_pin, NC); static DigitalOut shutdown2_pin(range2_XSHUT); static VL53L0X range2(&devI2c, &shutdown2_pin, NC); uint32_t distance1; uint32_t distance2; int dist1; int dist2; int status1; int status2; const static char DEVICE_NAME[] = "OCCUPY-CRICHTON-ST"; // change this static const uint16_t uuid16_list[] = {GattService::UUID_HEART_RATE_SERVICE}; //Custom UUID, FFFF is reserved for development HeartRateService *hrService; uint8_t hrmCounter = 0; void disconnectionCallback(const Gap::DisconnectionCallbackParams_t *) { BLE::Instance(BLE::DEFAULT_INSTANCE).gap().startAdvertising(); } void bleInitComplete(BLE::InitializationCompleteCallbackContext *params) { BLE &ble = params->ble; ble_error_t error = params->error; if (error != BLE_ERROR_NONE) { return; } ble.gap().onDisconnection(disconnectionCallback); hrService = new HeartRateService(ble, hrmCounter, HeartRateService::LOCATION_FINGER); ble.gap().accumulateAdvertisingPayload(GapAdvertisingData::BREDR_NOT_SUPPORTED | GapAdvertisingData::LE_GENERAL_DISCOVERABLE); // BLE only, no classic BT ble.gap().setAdvertisingType(GapAdvertisingParams::ADV_CONNECTABLE_UNDIRECTED); // advertising type ble.gap().accumulateAdvertisingPayload(GapAdvertisingData::COMPLETE_LOCAL_NAME, (uint8_t *)DEVICE_NAME, sizeof(DEVICE_NAME)); // add name ble.gap().accumulateAdvertisingPayload(GapAdvertisingData::COMPLETE_LIST_16BIT_SERVICE_IDS, (uint8_t *)uuid16_list, sizeof(uuid16_list)); // UUID's broadcast in advertising packet ble.gap().setAdvertisingInterval(100); // 100ms. ble.gap().accumulateAdvertisingPayload(GapAdvertisingData::GENERIC_HEART_RATE_SENSOR); ble.gap().startAdvertising(); } int format_dist(int distance) { // local variable declaration int result; if (distance > 1270) result = 127; else result = distance/10; return result; } void wakeup_event_cb() { led != led; status1 = range1.get_distance(&distance1); status2 = range2.get_distance(&distance2); dist1 = format_dist(distance1); dist2 = format_dist(distance2); if (status1 == VL53L0X_ERROR_NONE) { printf("Range1 [mm]: %6ld\r\n", dist1); if (dist1 > 4 && dist1 < 220) { led1 = 0; hrmCounter = dist1; hrService->updateHeartRate(hrmCounter); } else { led1 = 1; } } else { printf("Range1 [mm]: --\r\n"); led1 = 1; } if (status2 == VL53L0X_ERROR_NONE) { printf("Range2 [mm]: %6ld\r\n", dist2); if (dist2 > 4 && dist2 < 220) { led2 = 0; hrmCounter = dist2; hrService->updateHeartRate(hrmCounter); } } else { printf("Range2 [mm]: --\r\n"); led2 = 1; } } int main(void) { range1.init_sensor(range1_addr); range2.init_sensor(range2_addr); printf("\n\r********* Starting Main Loop *********\n\r"); BLE& ble = BLE::Instance(BLE::DEFAULT_INSTANCE); ble.init(bleInitComplete); Ticker ticker; ticker.attach(wakeup_event_cb, 0.3); while (ble.hasInitialized()) { ble.waitForEvent(); } }