Self test boot program for testing icarus sensors

Dependencies:   BLE_API mbed nRF51822

Fork of BLE_UARTConsole by Bluetooth Low Energy

main.cpp

Committer:
smigielski
Date:
2015-01-27
Revision:
9:ed3636e1873f
Parent:
8:e9ae7a01d866
Child:
11:70359785c2a7

File content as of revision 9:ed3636e1873f:

/* mbed Microcontroller Library
 * Copyright (c) 2006-2013 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 <string.h>
#include "mbed.h"
#include "BLEDevice.h"

#include "UARTService.h"

//Icarus libraries
#include "RNGSensor.h"

#define DEBUG 1 /* Set this if you need debug messages on the console;
                               * it will have an impact on code-size and power consumption. */

#if DEBUG
#define LOG_BUFFER 100
#define LOG(...)  do { if (uart) {snprintf(debugBuffer, LOG_BUFFER , __VA_ARGS__); uart->write(debugBuffer, strlen(debugBuffer));} } while (0)
#else
#define LOG_BUFFER 0
#define LOG(...) /* nothing */
#endif /* #if DEBUG */


BLEDevice  ble;
UARTService *uart;
RNGSensor sensor;

DigitalOut led(p5); 
DigitalOut motor(p6); 

DigitalIn button(p16,PullDown);

char debugBuffer[LOG_BUFFER];
uint32_t sensorErrors[10];


void disconnectionCallback(Gap::Handle_t handle, Gap::DisconnectionReason_t reason)
{
    LOG("Disconnected!\n\r");
    LOG("Restarting the advertising process\n\r");
    ble.startAdvertising();
}


int testSensors(void)
{
    uint32_t errorCount = sensor.verifyIntegrity(sensorErrors);
    if (errorCount>0){
        for (int i=0;i<errorCount;i++){
            LOG("ERROR: Sensor %s failed with error code: %d",sensor.getSimpleName(),sensorErrors[i]);
        }
    } else {
        LOG("Sensor %s validated!\n\r",sensor.getSimpleName());     
    }
    return errorCount;   
}

void periodicCallback(void)
{
    led=!led;
         if(button){
            motor=1;
        } else {
            motor =0;
        }
//    testSensors();
    LOG("ping\r\n");
}

int main(void)
{
    led=1;
    Ticker ticker;
    ticker.attach(periodicCallback, 1);

    LOG("Initialising the nRF51822\n\r");
    ble.init();
    ble.onDisconnection(disconnectionCallback);
    
    uart = new UARTService(ble);

    /* setup advertising */
    ble.accumulateAdvertisingPayload(GapAdvertisingData::BREDR_NOT_SUPPORTED);
    ble.setAdvertisingType(GapAdvertisingParams::ADV_CONNECTABLE_UNDIRECTED);
    ble.accumulateAdvertisingPayload(GapAdvertisingData::SHORTENED_LOCAL_NAME,
                                     (const uint8_t *)"BLE UART", sizeof("BLE UART") - 1);
    ble.accumulateAdvertisingPayload(GapAdvertisingData::COMPLETE_LIST_128BIT_SERVICE_IDS,
                                     (const uint8_t *)UARTServiceUUID_reversed, sizeof(UARTServiceUUID_reversed));

    ble.setAdvertisingInterval(160); /* 100ms; in multiples of 0.625ms. */
    ble.startAdvertising();

    while (true) {
        ble.waitForEvent();
    }
}