Icarus Sensors / Mbed 2 deprecated SelfTestBoot

Self test boot program for testing icarus sensors

Dependencies:   BLE_API mbed nRF51822

Fork of BLE_UARTConsole by Bluetooth Low Energy

main.cpp@8:e9ae7a01d866, 2015-01-27 (annotated)

Committer:
smigielski
Date:
Tue Jan 27 09:29:17 2015 +0000
Revision:
8:e9ae7a01d866
Parent:
7:438b55fe8576
Child:
9:ed3636e1873f
Add registers

Who changed what in which revision?

UserRevisionLine numberNew contents of line
rgrover1 0:2130d7f559dc 1 /* mbed Microcontroller Library
rgrover1 0:2130d7f559dc 2 * Copyright (c) 2006-2013 ARM Limited
rgrover1 0:2130d7f559dc 3 *
rgrover1 0:2130d7f559dc 4 * Licensed under the Apache License, Version 2.0 (the "License");
rgrover1 0:2130d7f559dc 5 * you may not use this file except in compliance with the License.
rgrover1 0:2130d7f559dc 6 * You may obtain a copy of the License at
rgrover1 0:2130d7f559dc 7 *
rgrover1 0:2130d7f559dc 8 * http://www.apache.org/licenses/LICENSE-2.0
rgrover1 0:2130d7f559dc 9 *
rgrover1 0:2130d7f559dc 10 * Unless required by applicable law or agreed to in writing, software
rgrover1 0:2130d7f559dc 11 * distributed under the License is distributed on an "AS IS" BASIS,
rgrover1 0:2130d7f559dc 12 * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
rgrover1 0:2130d7f559dc 13 * See the License for the specific language governing permissions and
rgrover1 0:2130d7f559dc 14 * limitations under the License.
rgrover1 0:2130d7f559dc 15 */
rgrover1 0:2130d7f559dc 16
rgrover1 5:2607923acfa1 17 #include <string.h>
rgrover1 0:2130d7f559dc 18 #include "mbed.h"
rgrover1 0:2130d7f559dc 19 #include "BLEDevice.h"
rgrover1 0:2130d7f559dc 20
rgrover1 0:2130d7f559dc 21 #include "UARTService.h"
rgrover1 0:2130d7f559dc 22
smigielski 7:438b55fe8576 23 //Icarus libraries
smigielski 7:438b55fe8576 24 #include "RNGSensor.h"
smigielski 7:438b55fe8576 25
smigielski 8:e9ae7a01d866 26 #define DEBUG 1 /* Set this if you need debug messages on the console;
rgrover1 0:2130d7f559dc 27 * it will have an impact on code-size and power consumption. */
smigielski 8:e9ae7a01d866 28
smigielski 8:e9ae7a01d866 29 #if DEBUG
smigielski 8:e9ae7a01d866 30 #define LOG_BUFFER 100
smigielski 8:e9ae7a01d866 31 #define LOG(...) do { if (uart) {snprintf(debugBuffer, LOG_BUFFER , __VA_ARGS__); uart->write(debugBuffer, strlen(debugBuffer));} } while (0)
rgrover1 0:2130d7f559dc 32 #else
smigielski 8:e9ae7a01d866 33 #define LOG_BUFFER 0
smigielski 8:e9ae7a01d866 34 #define LOG(...) /* nothing */
smigielski 8:e9ae7a01d866 35 #endif /* #if DEBUG */
smigielski 7:438b55fe8576 36
smigielski 7:438b55fe8576 37
rgrover1 0:2130d7f559dc 38 BLEDevice ble;
rgrover1 5:2607923acfa1 39 UARTService *uart;
smigielski 7:438b55fe8576 40 RNGSensor sensor;
smigielski 7:438b55fe8576 41
smigielski 8:e9ae7a01d866 42 DigitalOut led(p5);
smigielski 8:e9ae7a01d866 43 DigitalOut motor(p6);
smigielski 8:e9ae7a01d866 44
smigielski 8:e9ae7a01d866 45 DigitalIn button(p16,PullDown);
smigielski 8:e9ae7a01d866 46
smigielski 8:e9ae7a01d866 47 char debugBuffer[LOG_BUFFER];
smigielski 7:438b55fe8576 48 int sensorErrors[10];
smigielski 7:438b55fe8576 49
rgrover1 0:2130d7f559dc 50
rgrover1 0:2130d7f559dc 51 void disconnectionCallback(Gap::Handle_t handle, Gap::DisconnectionReason_t reason)
rgrover1 0:2130d7f559dc 52 {
smigielski 8:e9ae7a01d866 53 LOG("Disconnected!\n\r");
smigielski 8:e9ae7a01d866 54 LOG("Restarting the advertising process\n\r");
rgrover1 0:2130d7f559dc 55 ble.startAdvertising();
rgrover1 0:2130d7f559dc 56 }
rgrover1 0:2130d7f559dc 57
smigielski 8:e9ae7a01d866 58
smigielski 7:438b55fe8576 59 int testSensors(void)
smigielski 7:438b55fe8576 60 {
smigielski 7:438b55fe8576 61 int errorCount = sensor.verifyIntegrity(sensorErrors);
smigielski 7:438b55fe8576 62 if (errorCount>0){
smigielski 7:438b55fe8576 63 for (int i=0;i<errorCount;i++){
smigielski 8:e9ae7a01d866 64 LOG("ERROR: Sensor %s failed with error code: %d",sensor.getSimpleName(),sensorErrors[i]);
smigielski 7:438b55fe8576 65 }
smigielski 7:438b55fe8576 66 } else {
smigielski 8:e9ae7a01d866 67 LOG("Sensor %s validated!\n\r",sensor.getSimpleName());
smigielski 7:438b55fe8576 68 }
smigielski 7:438b55fe8576 69 return errorCount;
smigielski 7:438b55fe8576 70 }
rgrover1 0:2130d7f559dc 71
smigielski 8:e9ae7a01d866 72 void periodicCallback(void)
smigielski 8:e9ae7a01d866 73 {
smigielski 8:e9ae7a01d866 74 led=!led;
smigielski 8:e9ae7a01d866 75 if(button){
smigielski 8:e9ae7a01d866 76 motor=1;
smigielski 8:e9ae7a01d866 77 } else {
smigielski 8:e9ae7a01d866 78 motor =0;
smigielski 8:e9ae7a01d866 79 }
smigielski 8:e9ae7a01d866 80 // testSensors();
smigielski 8:e9ae7a01d866 81 LOG("ping\r\n");
smigielski 8:e9ae7a01d866 82 }
smigielski 8:e9ae7a01d866 83
rgrover1 0:2130d7f559dc 84 int main(void)
rgrover1 0:2130d7f559dc 85 {
smigielski 8:e9ae7a01d866 86 led=1;
rgrover1 0:2130d7f559dc 87 Ticker ticker;
rgrover1 0:2130d7f559dc 88 ticker.attach(periodicCallback, 1);
rgrover1 0:2130d7f559dc 89
smigielski 8:e9ae7a01d866 90 LOG("Initialising the nRF51822\n\r");
rgrover1 0:2130d7f559dc 91 ble.init();
rgrover1 0:2130d7f559dc 92 ble.onDisconnection(disconnectionCallback);
rgrover1 5:2607923acfa1 93
rgrover1 5:2607923acfa1 94 uart = new UARTService(ble);
rgrover1 0:2130d7f559dc 95
rgrover1 0:2130d7f559dc 96 /* setup advertising */
rgrover1 0:2130d7f559dc 97 ble.accumulateAdvertisingPayload(GapAdvertisingData::BREDR_NOT_SUPPORTED);
rgrover1 0:2130d7f559dc 98 ble.setAdvertisingType(GapAdvertisingParams::ADV_CONNECTABLE_UNDIRECTED);
rgrover1 0:2130d7f559dc 99 ble.accumulateAdvertisingPayload(GapAdvertisingData::SHORTENED_LOCAL_NAME,
rgrover1 0:2130d7f559dc 100 (const uint8_t *)"BLE UART", sizeof("BLE UART") - 1);
rgrover1 0:2130d7f559dc 101 ble.accumulateAdvertisingPayload(GapAdvertisingData::COMPLETE_LIST_128BIT_SERVICE_IDS,
rgrover1 0:2130d7f559dc 102 (const uint8_t *)UARTServiceUUID_reversed, sizeof(UARTServiceUUID_reversed));
rgrover1 0:2130d7f559dc 103
rgrover1 0:2130d7f559dc 104 ble.setAdvertisingInterval(160); /* 100ms; in multiples of 0.625ms. */
rgrover1 0:2130d7f559dc 105 ble.startAdvertising();
rgrover1 0:2130d7f559dc 106
rgrover1 0:2130d7f559dc 107 while (true) {
rgrover1 0:2130d7f559dc 108 ble.waitForEvent();
rgrover1 0:2130d7f559dc 109 }
smigielski 8:e9ae7a01d866 110 }