Odometry Pedometer using nRF51822 and ADXL345
Dependencies: ADXL345 BLE_API mbed nRF51822
Fork of BLE_CycleSpeedCadence by
main.cpp
- Committer:
- asyrofi
- Date:
- 2017-08-25
- Revision:
- 76:b56d8e15bdc6
- Parent:
- 75:7e334e81da21
File content as of revision 76:b56d8e15bdc6:
/* 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 "CyclingSpeedAndCadenceService.h"
#include "ble/services/BatteryService.h"
#include "ble/services/DeviceInformationService.h"
BLE ble;
Timer timer;
const static char DEVICE_NAME[] = "CSC1";
static const uint16_t uuid16_list[] = {GattService::UUID_CYCLING_SPEED_AND_CADENCE,
GattService::UUID_DEVICE_INFORMATION_SERVICE};
uint32_t t = 0;
uint32_t nextWheel = 0;
uint32_t nextCrank = 0;
static volatile bool triggerWheel = false;
static volatile bool triggerCrank = false;
void disconnectionCallback(Gap::Handle_t handle, Gap::DisconnectionReason_t reason)
{
ble.gap().startAdvertising(); // restart advertising
}
void onTick(void)
{
++t;
if (t >= nextWheel)
{
triggerWheel = true;
nextWheel += 7 + (rand() % 10);
}
if (t >= nextCrank)
{
triggerCrank = true;
nextCrank += 8 + (rand() % 20);
}
}
int main(void)
{
Ticker ticker;
ticker.attach(onTick, 0.1);
timer.start();
ble.init();
ble.gap().onDisconnection(disconnectionCallback);
/* Setup primary service. */
uint32_t wheelCounter = 100; // init Wheel to 100revs
uint16_t crankCounter = 10; // init crank to 10revs
CyclingSpeedAndCadenceService cscService(ble,
CyclingSpeedAndCadenceService::MODE_SPEED_CADENCE,
CyclingSpeedAndCadenceService::LOCATION_CHAINSTAY);
/* Setup auxiliary service. */
DeviceInformationService deviceInfo(ble, "ROB", "Model1", "SN1", "hw-rev1", "fw-rev1", "soft-rev1");
/* 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::CYCLING_SPEED_AND_CADENCE_SENSOR);
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();
nextWheel = 7 + (rand() % 10);
nextCrank = 8 + (rand() % 20);
// infinite loop
while (1) {
// check for trigger from periodicCallback()
if (ble.getGapState().connected)
{
if (triggerCrank && triggerWheel)
{
uint16_t when = (timer.read() * 1024);
cscService.updateCounters(++wheelCounter, ++crankCounter, when);
triggerWheel = false;
triggerCrank = false;
}
else if (triggerWheel)
{
uint16_t when = (timer.read() * 1024);
cscService.updateWheelCounter(++wheelCounter, when);
triggerWheel = false;
}
else if (triggerCrank)
{
uint16_t when = (timer.read() * 1024);
cscService.updateCrankCounter(++crankCounter, when);
triggerCrank = false;
}
else
{
ble.waitForEvent(); // low power wait for event
}
} else {
ble.waitForEvent(); // low power wait for event
}
}
}
