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@14:cb369746225d, 2015-04-15 (annotated)

Committer:
smigielski
Date:
Wed Apr 15 20:01:16 2015 +0000
Revision:
14:cb369746225d
Parent:
13:ef0ce8fa871f 
ADXL362 self test working

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>
smigielski 13:ef0ce8fa871f 18 #include <stdarg.h>
rgrover1 0:2130d7f559dc 19 #include "mbed.h"
rgrover1 0:2130d7f559dc 20
smigielski 7:438b55fe8576 21
smigielski 8:e9ae7a01d866 22 #define DEBUG 1 /* Set this if you need debug messages on the console;
rgrover1 0:2130d7f559dc 23 * it will have an impact on code-size and power consumption. */
smigielski 8:e9ae7a01d866 24
smigielski 13:ef0ce8fa871f 25 //Icarus libraries
smigielski 13:ef0ce8fa871f 26 #include "ADXL362Sensor.h"
smigielski 13:ef0ce8fa871f 27 #include "MPU9250Sensor.h"
smigielski 13:ef0ce8fa871f 28
smigielski 14:cb369746225d 29
smigielski 14:cb369746225d 30
smigielski 14:cb369746225d 31 #define BAUD_RATE 115200
smigielski 14:cb369746225d 32 Serial s(P0_5, P0_6);
smigielski 13:ef0ce8fa871f 33
smigielski 8:e9ae7a01d866 34 #if DEBUG
smigielski 8:e9ae7a01d866 35 #define LOG_BUFFER 100
smigielski 13:ef0ce8fa871f 36 #define LOG(...) do { if (debug) { debug( __VA_ARGS__); } } while (0)
rgrover1 0:2130d7f559dc 37 #else
smigielski 8:e9ae7a01d866 38 #define LOG_BUFFER 0
smigielski 8:e9ae7a01d866 39 #define LOG(...) /* nothing */
smigielski 8:e9ae7a01d866 40 #endif /* #if DEBUG */
smigielski 13:ef0ce8fa871f 41 char debugBuffer[LOG_BUFFER];
smigielski 13:ef0ce8fa871f 42 void debug ( const char* format, ...) {
smigielski 13:ef0ce8fa871f 43 va_list argptr;
smigielski 13:ef0ce8fa871f 44 va_start(argptr, format);
smigielski 14:cb369746225d 45 // vsnprintf(debugBuffer, LOG_BUFFER ,format, argptr);
smigielski 14:cb369746225d 46 vprintf(format, argptr);
smigielski 13:ef0ce8fa871f 47 va_end(argptr);
smigielski 14:cb369746225d 48 // if (uart){
smigielski 14:cb369746225d 49 // uart->write(debugBuffer, strlen(debugBuffer));
smigielski 14:cb369746225d 50 // }
smigielski 13:ef0ce8fa871f 51 }
smigielski 7:438b55fe8576 52
smigielski 7:438b55fe8576 53
smigielski 11:70359785c2a7 54
smigielski 14:cb369746225d 55 SPI spi1(P0_28, P0_24, P0_29); // mosi, miso, sclk
smigielski 11:70359785c2a7 56 DigitalOut adxl_cs(P0_23);
smigielski 13:ef0ce8fa871f 57 DigitalOut mpu_cs(P0_18);
smigielski 7:438b55fe8576 58
smigielski 11:70359785c2a7 59 DigitalOut led(P0_5);
smigielski 11:70359785c2a7 60 DigitalOut motor(P0_6);
smigielski 8:e9ae7a01d866 61
smigielski 11:70359785c2a7 62 DigitalIn button(P0_16,PullDown);
smigielski 8:e9ae7a01d866 63
smigielski 13:ef0ce8fa871f 64
smigielski 14:cb369746225d 65
smigielski 9:ed3636e1873f 66 uint32_t sensorErrors[10];
smigielski 7:438b55fe8576 67
rgrover1 0:2130d7f559dc 68
smigielski 13:ef0ce8fa871f 69 ADXL362Sensor adxl362(spi1, adxl_cs, debug);
smigielski 13:ef0ce8fa871f 70 MPU9250Sensor mpu9250(spi1, mpu_cs, debug);
smigielski 13:ef0ce8fa871f 71
smigielski 14:cb369746225d 72
rgrover1 0:2130d7f559dc 73
smigielski 8:e9ae7a01d866 74
smigielski 13:ef0ce8fa871f 75 int testSensors(BaseSensor& sensor)
smigielski 7:438b55fe8576 76 {
smigielski 9:ed3636e1873f 77 uint32_t errorCount = sensor.verifyIntegrity(sensorErrors);
smigielski 7:438b55fe8576 78 if (errorCount>0){
smigielski 7:438b55fe8576 79 for (int i=0;i<errorCount;i++){
smigielski 13:ef0ce8fa871f 80 LOG("ERROR: Sensor %s failed with error code: %d\n\r",sensor.getSimpleName(),sensorErrors[i]);
smigielski 7:438b55fe8576 81 }
smigielski 7:438b55fe8576 82 } else {
smigielski 8:e9ae7a01d866 83 LOG("Sensor %s validated!\n\r",sensor.getSimpleName());
smigielski 7:438b55fe8576 84 }
smigielski 7:438b55fe8576 85 return errorCount;
smigielski 7:438b55fe8576 86 }
rgrover1 0:2130d7f559dc 87
smigielski 14:cb369746225d 88
smigielski 8:e9ae7a01d866 89
rgrover1 0:2130d7f559dc 90 int main(void)
rgrover1 0:2130d7f559dc 91 {
smigielski 14:cb369746225d 92 s.baud(BAUD_RATE);
smigielski 14:cb369746225d 93
rgrover1 0:2130d7f559dc 94
smigielski 8:e9ae7a01d866 95 LOG("Initialising the nRF51822\n\r");
rgrover1 0:2130d7f559dc 96
rgrover1 0:2130d7f559dc 97 while (true) {
smigielski 14:cb369746225d 98 testSensors(adxl362);
smigielski 14:cb369746225d 99 // testSensors(mpu9250);
smigielski 14:cb369746225d 100 wait(10.0f);
rgrover1 0:2130d7f559dc 101 }
smigielski 8:e9ae7a01d866 102 }