Self test boot program for testing icarus sensors
Dependencies: BLE_API mbed nRF51822
Fork of BLE_UARTConsole by
main.cpp@9:ed3636e1873f, 2015-01-27 (annotated)
- Committer:
- smigielski
- Date:
- Tue Jan 27 12:30:51 2015 +0000
- Revision:
- 9:ed3636e1873f
- Parent:
- 8:e9ae7a01d866
- Child:
- 11:70359785c2a7
ADXL362 is compiling
Who changed what in which revision?
User | Revision | Line number | New 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 | 9:ed3636e1873f | 48 | uint32_t 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 | 9:ed3636e1873f | 61 | uint32_t 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 | } |