Merck / Mbed OS SmartCap_OS5

Dependencies:   nRF51822

Source/main.cpp@34:c122d842ad9a, 2019-09-17 (annotated)

Committer:
sgetz7908
Date:
Tue Sep 17 13:35:35 2019 +0000
Revision:
34:c122d842ad9a
Parent:
30:76b51e525c40
Child:
35:e8fa201fe147
Advertises forever when in test mode.;

Who changed what in which revision?

UserRevisionLine numberNew contents of line
sgetz7908 23:7ca590427f0e 1 //**********************************************************************
sgetz7908 23:7ca590427f0e 2 //
sgetz7908 23:7ca590427f0e 3 // SmartCap2 Main
sgetz7908 23:7ca590427f0e 4 //
sgetz7908 23:7ca590427f0e 5 // SPG 2/22/2019
sgetz7908 23:7ca590427f0e 6 //
sgetz7908 23:7ca590427f0e 7 // Copyright (c) 2019 Polygenesis
sgetz7908 23:7ca590427f0e 8 //
sgetz7908 23:7ca590427f0e 9 //**********************************************************************
sgetz7908 23:7ca590427f0e 10 /// @file main.cpp
sgetz7908 23:7ca590427f0e 11
sgetz7908 23:7ca590427f0e 12 #include <events/mbed_events.h>
sgetz7908 23:7ca590427f0e 13 #include <mbed.h>
sgetz7908 24:761c30334cf4 14 #include <ctype.h>
sgetz7908 23:7ca590427f0e 15 #include "main.h"
sgetz7908 23:7ca590427f0e 16 #include "hw.h"
sgetz7908 23:7ca590427f0e 17 #include "ble/BLE.h"
sgetz7908 23:7ca590427f0e 18 #include "ble/Gap.h"
sgetz7908 23:7ca590427f0e 19 #include "BLE_Stuff.h"
sgetz7908 23:7ca590427f0e 20 #include "ble/services/UARTService.h"
sgetz7908 23:7ca590427f0e 21 #include "infoService.h"
sgetz7908 23:7ca590427f0e 22 #include "log.h"
sgetz7908 23:7ca590427f0e 23 #include "nrf_soc.h"
sgetz7908 23:7ca590427f0e 24 #include "mem.h"
sgetz7908 26:a577c4b69fe0 25 #include "CCITTcrc16.h"
sgetz7908 23:7ca590427f0e 26
sgetz7908 23:7ca590427f0e 27 void process_state(void);
sgetz7908 24:761c30334cf4 28 void start_periodic_tick(uint32_t sec);
sgetz7908 23:7ca590427f0e 29
sgetz7908 23:7ca590427f0e 30 EventQueue eventQueue(/* event count */ 16 * EVENTS_EVENT_SIZE);
sgetz7908 23:7ca590427f0e 31
sgetz7908 23:7ca590427f0e 32 #if TEST_ON_NRF51_DK==0
sgetz7908 23:7ca590427f0e 33 // real board
sgetz7908 23:7ca590427f0e 34 //int reg_mode = 1;
sgetz7908 27:bb7247a1704e 35 InterruptIn is_package_open(LIGHT_SENSE, PullNone); // will be pulled hi when package_is_open (only if package_open_sense_enable = 1)
sgetz7908 23:7ca590427f0e 36 DigitalOut package_open_sense_enable(LIGHT_SENSE_ENABLE, 0);
sgetz7908 23:7ca590427f0e 37
sgetz7908 23:7ca590427f0e 38 DigitalOut cap_sense_led(CAP_SENSE_LED, 0);
sgetz7908 23:7ca590427f0e 39 DigitalOut vdd_enable(VDD_ENABLE, 0);
sgetz7908 23:7ca590427f0e 40
sgetz7908 23:7ca590427f0e 41 DigitalOut led(LED, 0); // LED for debugging purposes
sgetz7908 24:761c30334cf4 42
sgetz7908 24:761c30334cf4 43 #if UART_DEBUGGING
sgetz7908 24:761c30334cf4 44 #define debug(STR) BLE_UART_xmit(STR); BLE_UART_xmit("\n");
sgetz7908 24:761c30334cf4 45 #else
sgetz7908 24:761c30334cf4 46 #define debug(...)
sgetz7908 24:761c30334cf4 47 #endif
sgetz7908 23:7ca590427f0e 48 #else
sgetz7908 23:7ca590427f0e 49 // simulate on nRF51-DK
sgetz7908 23:7ca590427f0e 50 DigitalIn capon(BUTTON1, PullUp);
sgetz7908 23:7ca590427f0e 51 //DigitalIn reg_mode(BUTTON3, PullUp);
sgetz7908 24:761c30334cf4 52 InterruptIn is_package_open(BUTTON2, PullUp); // will be pulled hi when package_is_open
sgetz7908 23:7ca590427f0e 53 DigitalOut package_open_sense_enable(LED3, 0);
sgetz7908 23:7ca590427f0e 54
sgetz7908 23:7ca590427f0e 55 DigitalOut cap_sense_led(LED2, 0);
sgetz7908 23:7ca590427f0e 56 DigitalOut vdd_enable(LED4, 0);
sgetz7908 23:7ca590427f0e 57
sgetz7908 23:7ca590427f0e 58 DigitalOut led(LED1, 0); // LED for debugging purposes
sgetz7908 24:761c30334cf4 59 #if UART_DEBUGGING
sgetz7908 24:761c30334cf4 60 Serial pc(USBTX, USBRX); // tx, rx
sgetz7908 24:761c30334cf4 61 #define debug(STR) pc.printf(STR)
sgetz7908 24:761c30334cf4 62 #else
sgetz7908 24:761c30334cf4 63 #define debug(...)
sgetz7908 24:761c30334cf4 64 #endif
sgetz7908 23:7ca590427f0e 65 #endif
sgetz7908 23:7ca590427f0e 66
sgetz7908 23:7ca590427f0e 67 LowPowerTicker periodic_ticker; // this handle the RTC
sgetz7908 23:7ca590427f0e 68
sgetz7908 24:761c30334cf4 69 float tick_rate = FAST_TICK_SEC;
sgetz7908 23:7ca590427f0e 70
sgetz7908 24:761c30334cf4 71 bool package_open_detected = false;
sgetz7908 23:7ca590427f0e 72 bool is_cap_off = false; // 0=cap on, 1=cap off
sgetz7908 23:7ca590427f0e 73 uint32_t cap_off_time;
sgetz7908 23:7ca590427f0e 74
sgetz7908 24:761c30334cf4 75 uint16_t off_reading;
sgetz7908 24:761c30334cf4 76 uint16_t on_reading;
sgetz7908 24:761c30334cf4 77
sgetz7908 23:7ca590427f0e 78 typedef enum {
sgetz7908 23:7ca590427f0e 79 INIT,
sgetz7908 23:7ca590427f0e 80 POST,
sgetz7908 23:7ca590427f0e 81 TEST_MODE,
sgetz7908 23:7ca590427f0e 82 SHIP_MODE_WAIT_DARK,
sgetz7908 23:7ca590427f0e 83 SHIP_MODE_WAIT_LIGHT,
sgetz7908 24:761c30334cf4 84 SHIP_MODE_CHECK_CAP,
sgetz7908 23:7ca590427f0e 85 SHIP_MODE_WAIT_CAP_OFF,
sgetz7908 23:7ca590427f0e 86 IN_USE_SETUP,
sgetz7908 23:7ca590427f0e 87 WAIT_CAP_OFF,
sgetz7908 23:7ca590427f0e 88 WAIT_CAP_ON,
sgetz7908 26:a577c4b69fe0 89 EOL_WAIT_CAP_OFF,
sgetz7908 26:a577c4b69fe0 90 EOL_WAIT_CAP_ON,
sgetz7908 26:a577c4b69fe0 91 EOL_WAIT_LIGHT,
sgetz7908 23:7ca590427f0e 92 OTHER
sgetz7908 23:7ca590427f0e 93 } state_t;
sgetz7908 23:7ca590427f0e 94
sgetz7908 23:7ca590427f0e 95 state_t state = INIT;
sgetz7908 23:7ca590427f0e 96
sgetz7908 23:7ca590427f0e 97 /// Light detected interrupt
sgetz7908 23:7ca590427f0e 98 void light_interrupt(void)
sgetz7908 24:761c30334cf4 99 { // dark to light transition
sgetz7908 24:761c30334cf4 100 package_open_detected = true;
sgetz7908 25:42163d650266 101 start_periodic_tick(FAST_TICK_SEC);
sgetz7908 23:7ca590427f0e 102 }
sgetz7908 23:7ca590427f0e 103
sgetz7908 23:7ca590427f0e 104 /// Test to see if Cap is off or on
sgetz7908 23:7ca590427f0e 105 void test_cap(void)
sgetz7908 23:7ca590427f0e 106 {
sgetz7908 24:761c30334cf4 107 #if TEST_ON_NRF51_DK == 0
sgetz7908 23:7ca590427f0e 108 vdd_enable = 1; // enable analog power
sgetz7908 23:7ca590427f0e 109 wait(0.00075);
sgetz7908 23:7ca590427f0e 110 off_reading = adc_read(ADC_CHAN_CAP_SENSE,2);
sgetz7908 23:7ca590427f0e 111 cap_sense_led = 1; // enable led
sgetz7908 23:7ca590427f0e 112 wait(0.00075);
sgetz7908 23:7ca590427f0e 113 on_reading = adc_read(ADC_CHAN_CAP_SENSE,2);
sgetz7908 23:7ca590427f0e 114 // turn everything off
sgetz7908 23:7ca590427f0e 115 cap_sense_led = 0;
sgetz7908 23:7ca590427f0e 116 vdd_enable = 0;
sgetz7908 23:7ca590427f0e 117
sgetz7908 23:7ca590427f0e 118 if(on_reading > off_reading+CAP_THRESHOLD)
sgetz7908 23:7ca590427f0e 119 #else
sgetz7908 23:7ca590427f0e 120 if(capon)
sgetz7908 23:7ca590427f0e 121 #endif
sgetz7908 23:7ca590427f0e 122 {
sgetz7908 23:7ca590427f0e 123 is_cap_off = 0;
sgetz7908 24:761c30334cf4 124 #if ENABLE_LED
sgetz7908 24:761c30334cf4 125 led = 0;
sgetz7908 24:761c30334cf4 126 #endif
sgetz7908 23:7ca590427f0e 127 }
sgetz7908 23:7ca590427f0e 128 else
sgetz7908 23:7ca590427f0e 129 {
sgetz7908 23:7ca590427f0e 130 is_cap_off = 1;
sgetz7908 24:761c30334cf4 131 #if ENABLE_LED
sgetz7908 24:761c30334cf4 132 led = 1;
sgetz7908 24:761c30334cf4 133 #endif
sgetz7908 23:7ca590427f0e 134 }
sgetz7908 24:761c30334cf4 135 }
sgetz7908 24:761c30334cf4 136
sgetz7908 24:761c30334cf4 137 void periodic_tick_task(void)
sgetz7908 24:761c30334cf4 138 {
sgetz7908 24:761c30334cf4 139 test_cap();
sgetz7908 24:761c30334cf4 140 process_state();
sgetz7908 23:7ca590427f0e 141 }
sgetz7908 23:7ca590427f0e 142
sgetz7908 23:7ca590427f0e 143 /// this interrupt is run every PERIODIC_TICK_SEC seconds
sgetz7908 23:7ca590427f0e 144 void periodic_tick()
sgetz7908 23:7ca590427f0e 145 {
sgetz7908 24:761c30334cf4 146 update_rtc(tick_rate); // keep rtc updated
sgetz7908 24:761c30334cf4 147 eventQueue.call(periodic_tick_task); // starts as non-interrupt task so we can use wait();
sgetz7908 24:761c30334cf4 148 }
sgetz7908 24:761c30334cf4 149
sgetz7908 24:761c30334cf4 150 void start_periodic_tick(uint32_t sec)
sgetz7908 24:761c30334cf4 151 {
sgetz7908 24:761c30334cf4 152 tick_rate = sec;
sgetz7908 24:761c30334cf4 153 periodic_ticker.detach();
sgetz7908 24:761c30334cf4 154 periodic_ticker.attach(&periodic_tick ,sec);
sgetz7908 24:761c30334cf4 155 }
sgetz7908 24:761c30334cf4 156
sgetz7908 24:761c30334cf4 157 void stop_periodic_tick(void)
sgetz7908 24:761c30334cf4 158 {
sgetz7908 24:761c30334cf4 159 periodic_ticker.detach();
sgetz7908 23:7ca590427f0e 160 }
sgetz7908 23:7ca590427f0e 161
sgetz7908 23:7ca590427f0e 162 /// call here to flash the LED n times.
sgetz7908 23:7ca590427f0e 163 // n=0 to flash forever
sgetz7908 23:7ca590427f0e 164 void flash_led(int n, float sec)
sgetz7908 23:7ca590427f0e 165 {
sgetz7908 23:7ca590427f0e 166 if(n==0)
sgetz7908 23:7ca590427f0e 167 { // flash forever
sgetz7908 23:7ca590427f0e 168 while(1)
sgetz7908 23:7ca590427f0e 169 {
sgetz7908 23:7ca590427f0e 170 led = 1;
sgetz7908 23:7ca590427f0e 171 wait(sec);
sgetz7908 23:7ca590427f0e 172 led = 0;
sgetz7908 23:7ca590427f0e 173 wait(sec);
sgetz7908 23:7ca590427f0e 174 }
sgetz7908 23:7ca590427f0e 175 }
sgetz7908 23:7ca590427f0e 176 else
sgetz7908 23:7ca590427f0e 177 { // flash n times
sgetz7908 23:7ca590427f0e 178 while(n--)
sgetz7908 23:7ca590427f0e 179 {
sgetz7908 23:7ca590427f0e 180 led = 1;
sgetz7908 23:7ca590427f0e 181 wait(sec);
sgetz7908 23:7ca590427f0e 182 led = 0;
sgetz7908 23:7ca590427f0e 183 wait(sec);
sgetz7908 23:7ca590427f0e 184 }
sgetz7908 23:7ca590427f0e 185 }
sgetz7908 23:7ca590427f0e 186 }
sgetz7908 23:7ca590427f0e 187
sgetz7908 23:7ca590427f0e 188
sgetz7908 23:7ca590427f0e 189 state_t last_state = OTHER;
sgetz7908 27:bb7247a1704e 190 int last_cap;
sgetz7908 23:7ca590427f0e 191
sgetz7908 23:7ca590427f0e 192 /// Main state machine
sgetz7908 23:7ca590427f0e 193 /// Called whenever a sensor changes
sgetz7908 23:7ca590427f0e 194 void process_state(void)
sgetz7908 23:7ca590427f0e 195 {
sgetz7908 24:761c30334cf4 196 do
sgetz7908 23:7ca590427f0e 197 {
sgetz7908 24:761c30334cf4 198 #if UART_DEBUGGING==1
sgetz7908 24:761c30334cf4 199 if(last_state != state)
sgetz7908 24:761c30334cf4 200 {
sgetz7908 24:761c30334cf4 201 debug(uli2a(state));
sgetz7908 24:761c30334cf4 202 debug("\n");
sgetz7908 24:761c30334cf4 203 }
sgetz7908 24:761c30334cf4 204 #endif
sgetz7908 23:7ca590427f0e 205 last_state = state;
sgetz7908 23:7ca590427f0e 206
sgetz7908 24:761c30334cf4 207 switch(state)
sgetz7908 24:761c30334cf4 208 {
sgetz7908 24:761c30334cf4 209 case INIT:
sgetz7908 24:761c30334cf4 210 log_add(EVENT_POWER, 0, 0, 0); // log event
sgetz7908 34:c122d842ad9a 211
sgetz7908 25:42163d650266 212 start_periodic_tick(FAST_TICK_SEC);
sgetz7908 24:761c30334cf4 213 #if SKIP_SHIP_MODE
sgetz7908 24:761c30334cf4 214 state = IN_USE_SETUP;
sgetz7908 24:761c30334cf4 215 #else
sgetz7908 24:761c30334cf4 216 state = POST;
sgetz7908 24:761c30334cf4 217 #endif
sgetz7908 24:761c30334cf4 218 break;
sgetz7908 24:761c30334cf4 219
sgetz7908 24:761c30334cf4 220 case POST:
sgetz7908 24:761c30334cf4 221 // check CRC ?
sgetz7908 24:761c30334cf4 222
sgetz7908 24:761c30334cf4 223 // Check Misc.
sgetz7908 24:761c30334cf4 224
sgetz7908 24:761c30334cf4 225 //if(error) flash_led(0,0.1); // flash forever to indicate error
sgetz7908 25:42163d650266 226
sgetz7908 24:761c30334cf4 227 if(NV_TESTING_REQUIRED)
sgetz7908 24:761c30334cf4 228 {
sgetz7908 24:761c30334cf4 229 flash_led(1, 1.0);
sgetz7908 24:761c30334cf4 230 package_open_sense_enable = 1;
sgetz7908 25:42163d650266 231 start_periodic_tick(FAST_TICK_SEC);
sgetz7908 27:bb7247a1704e 232 last_cap = 99;
sgetz7908 34:c122d842ad9a 233 set_radio(true, 0); // advertise forever until stopped
sgetz7908 24:761c30334cf4 234 state = TEST_MODE;
sgetz7908 24:761c30334cf4 235 }
sgetz7908 24:761c30334cf4 236 else
sgetz7908 24:761c30334cf4 237 {
sgetz7908 24:761c30334cf4 238 state = IN_USE_SETUP;
sgetz7908 24:761c30334cf4 239 }
sgetz7908 25:42163d650266 240
sgetz7908 24:761c30334cf4 241 break;
sgetz7908 24:761c30334cf4 242
sgetz7908 25:42163d650266 243 case TEST_MODE:
sgetz7908 24:761c30334cf4 244 test_cap();
sgetz7908 24:761c30334cf4 245 led = is_cap_off;
sgetz7908 27:bb7247a1704e 246 if(last_cap != is_cap_off)
sgetz7908 27:bb7247a1704e 247 {
sgetz7908 27:bb7247a1704e 248 last_cap = is_cap_off;
sgetz7908 27:bb7247a1704e 249 BLE_UART_xmit("*Cap ");
sgetz7908 27:bb7247a1704e 250 if(last_cap) BLE_UART_xmit("Off"); else BLE_UART_xmit("On");
sgetz7908 27:bb7247a1704e 251 BLE_UART_xmit("\n");
sgetz7908 27:bb7247a1704e 252 }
sgetz7908 25:42163d650266 253 if(!NV_TESTING_REQUIRED && is_package_open)
sgetz7908 24:761c30334cf4 254 { // testing passed
sgetz7908 24:761c30334cf4 255 set_radio(false); // already done when NV_TESTING_REQUIRED was cleared.
sgetz7908 24:761c30334cf4 256 led = 0;
sgetz7908 24:761c30334cf4 257 state = SHIP_MODE_WAIT_DARK;
sgetz7908 24:761c30334cf4 258 }
sgetz7908 24:761c30334cf4 259 break;
sgetz7908 24:761c30334cf4 260
sgetz7908 24:761c30334cf4 261 case SHIP_MODE_WAIT_DARK: // Wait for light sensor to see darkness
sgetz7908 27:bb7247a1704e 262 //flash_led(1,0.1);
sgetz7908 25:42163d650266 263 if(!is_package_open)
sgetz7908 24:761c30334cf4 264 { // its dark
sgetz7908 24:761c30334cf4 265 state = SHIP_MODE_WAIT_LIGHT;
sgetz7908 24:761c30334cf4 266 }
sgetz7908 24:761c30334cf4 267 break;
sgetz7908 24:761c30334cf4 268
sgetz7908 24:761c30334cf4 269 case SHIP_MODE_WAIT_LIGHT:
sgetz7908 24:761c30334cf4 270 // set up and enable the Light Sense Interrupt
sgetz7908 24:761c30334cf4 271 // go to lowest power state
sgetz7908 25:42163d650266 272
sgetz7908 24:761c30334cf4 273 debug("Going SHIP MODE\n");
sgetz7908 24:761c30334cf4 274 is_package_open.disable_irq();
sgetz7908 24:761c30334cf4 275 stop_periodic_tick();
sgetz7908 24:761c30334cf4 276 led = 0;
sgetz7908 24:761c30334cf4 277 package_open_detected = false;
sgetz7908 26:a577c4b69fe0 278 //is_package_open.mode(PullDown);
sgetz7908 24:761c30334cf4 279 is_package_open.rise(&light_interrupt);
sgetz7908 24:761c30334cf4 280 is_package_open.enable_irq();
sgetz7908 24:761c30334cf4 281 state = SHIP_MODE_CHECK_CAP;
sgetz7908 24:761c30334cf4 282
sgetz7908 23:7ca590427f0e 283 break;
sgetz7908 23:7ca590427f0e 284
sgetz7908 24:761c30334cf4 285 case SHIP_MODE_CHECK_CAP:
sgetz7908 25:42163d650266 286
sgetz7908 24:761c30334cf4 287 if(package_open_detected)
sgetz7908 24:761c30334cf4 288 {
sgetz7908 24:761c30334cf4 289 debug("Awake\n");
sgetz7908 27:bb7247a1704e 290 //flash_led(3,0.25);
sgetz7908 24:761c30334cf4 291 test_cap();
sgetz7908 24:761c30334cf4 292 if(is_cap_off)
sgetz7908 24:761c30334cf4 293 {
sgetz7908 24:761c30334cf4 294 state = SHIP_MODE_WAIT_DARK;
sgetz7908 24:761c30334cf4 295 }
sgetz7908 24:761c30334cf4 296 else
sgetz7908 24:761c30334cf4 297 {
sgetz7908 24:761c30334cf4 298 state = SHIP_MODE_WAIT_CAP_OFF;
sgetz7908 24:761c30334cf4 299 }
sgetz7908 24:761c30334cf4 300 }
sgetz7908 24:761c30334cf4 301 break;
sgetz7908 24:761c30334cf4 302
sgetz7908 24:761c30334cf4 303 case SHIP_MODE_WAIT_CAP_OFF:
sgetz7908 25:42163d650266 304 if(!is_package_open)
sgetz7908 24:761c30334cf4 305 {
sgetz7908 24:761c30334cf4 306 state = SHIP_MODE_WAIT_LIGHT;
sgetz7908 24:761c30334cf4 307 }
sgetz7908 24:761c30334cf4 308 else
sgetz7908 24:761c30334cf4 309 {
sgetz7908 24:761c30334cf4 310 test_cap();
sgetz7908 24:761c30334cf4 311 if(is_cap_off)
sgetz7908 24:761c30334cf4 312 {
sgetz7908 24:761c30334cf4 313 package_open_sense_enable = 0;
sgetz7908 24:761c30334cf4 314 log_add(EVENT_WAKE_FROM_SHIP, 0, 0, 0);
sgetz7908 24:761c30334cf4 315 state = IN_USE_SETUP;
sgetz7908 24:761c30334cf4 316 }
sgetz7908 24:761c30334cf4 317 }
sgetz7908 24:761c30334cf4 318 break;
sgetz7908 24:761c30334cf4 319
sgetz7908 24:761c30334cf4 320 case IN_USE_SETUP:
sgetz7908 25:42163d650266 321 flash_led(3, .25);
sgetz7908 24:761c30334cf4 322 start_periodic_tick(PERIODIC_TICK_SEC);
sgetz7908 26:a577c4b69fe0 323 debug("In Use\n");
sgetz7908 26:a577c4b69fe0 324 if(NV_NOT_IN_USE) nv_clear(NV_NOT_IN_USE_ADDR);
sgetz7908 24:761c30334cf4 325 state = WAIT_CAP_OFF;
sgetz7908 24:761c30334cf4 326 break;
sgetz7908 23:7ca590427f0e 327
sgetz7908 24:761c30334cf4 328 case WAIT_CAP_OFF: // cap is on, waiting for cap to be removed
sgetz7908 26:a577c4b69fe0 329 if(read_clock()>((uint32_t)EOL_TIMEOUT_DAYS*24*60*60))
sgetz7908 26:a577c4b69fe0 330 { // EOL detected due to maximum time
sgetz7908 27:bb7247a1704e 331 if(NV_NOT_EOL) nv_clear(NV_NOT_EOL_ADDR);
sgetz7908 26:a577c4b69fe0 332 }
sgetz7908 26:a577c4b69fe0 333
sgetz7908 26:a577c4b69fe0 334 if(!NV_NOT_EOL)
sgetz7908 26:a577c4b69fe0 335 { // EOL flagged
sgetz7908 27:bb7247a1704e 336 if(log_code_count(EVENT_EOL)==0) log_add(EVENT_EOL, 0, 0, 0); // log event
sgetz7908 27:bb7247a1704e 337 start_periodic_tick(EOL_TICK_SEC); // just tick less often
sgetz7908 26:a577c4b69fe0 338 state = EOL_WAIT_CAP_OFF;
sgetz7908 26:a577c4b69fe0 339 }
sgetz7908 26:a577c4b69fe0 340 else if(is_cap_off)
sgetz7908 26:a577c4b69fe0 341 { // cap just taken off
sgetz7908 26:a577c4b69fe0 342 // save cap off time
sgetz7908 26:a577c4b69fe0 343 cap_off_time = read_clock();
sgetz7908 26:a577c4b69fe0 344 debug("Cap Off \n");
sgetz7908 26:a577c4b69fe0 345 state = WAIT_CAP_ON;
sgetz7908 26:a577c4b69fe0 346 }
sgetz7908 24:761c30334cf4 347
sgetz7908 24:761c30334cf4 348 break;
sgetz7908 24:761c30334cf4 349
sgetz7908 24:761c30334cf4 350 case WAIT_CAP_ON: // cap currently off, waiting for cap to be put on
sgetz7908 26:a577c4b69fe0 351 if(!is_cap_off)
sgetz7908 26:a577c4b69fe0 352 { // cap just put on
sgetz7908 26:a577c4b69fe0 353 // log time cap was off
sgetz7908 26:a577c4b69fe0 354 uint32_t cap_off_dur = read_clock()-cap_off_time;
sgetz7908 26:a577c4b69fe0 355 if(cap_off_dur>65535) cap_off_dur = 65535;
sgetz7908 26:a577c4b69fe0 356 log_add(EVENT_CAP_ON, cap_off_dur & 0xff, (cap_off_dur >> 8)&0xff, 0); // log event
sgetz7908 26:a577c4b69fe0 357
sgetz7908 26:a577c4b69fe0 358 if(log_code_count(EVENT_CAP_ON)>= EOL_MAX_USES)
sgetz7908 26:a577c4b69fe0 359 { // EOL detected due to maximum uses
sgetz7908 27:bb7247a1704e 360 if(NV_NOT_EOL) nv_clear(NV_NOT_EOL_ADDR);
sgetz7908 26:a577c4b69fe0 361 }
sgetz7908 27:bb7247a1704e 362
sgetz7908 27:bb7247a1704e 363 set_radio(true);
sgetz7908 27:bb7247a1704e 364 state = WAIT_CAP_OFF;
sgetz7908 26:a577c4b69fe0 365 }
sgetz7908 26:a577c4b69fe0 366 break;
sgetz7908 24:761c30334cf4 367
sgetz7908 26:a577c4b69fe0 368 case EOL_WAIT_CAP_OFF: // Cap is on
sgetz7908 26:a577c4b69fe0 369 if(is_cap_off)
sgetz7908 26:a577c4b69fe0 370 { // cap just taken off
sgetz7908 26:a577c4b69fe0 371 debug("EOL Cap Off \n");
sgetz7908 26:a577c4b69fe0 372 state = EOL_WAIT_CAP_ON;
sgetz7908 26:a577c4b69fe0 373 }
sgetz7908 27:bb7247a1704e 374 //else if(!is_package_open)
sgetz7908 27:bb7247a1704e 375 //{ // its dark
sgetz7908 27:bb7247a1704e 376 // start_periodic_tick(EOL_TICK_SEC); // just tick less often
sgetz7908 27:bb7247a1704e 377 // state = EOL_WAIT_LIGHT;
sgetz7908 27:bb7247a1704e 378 //}
sgetz7908 26:a577c4b69fe0 379 break;
sgetz7908 26:a577c4b69fe0 380
sgetz7908 26:a577c4b69fe0 381 case EOL_WAIT_CAP_ON: // Cap is off
sgetz7908 26:a577c4b69fe0 382 if(!is_cap_off)
sgetz7908 26:a577c4b69fe0 383 { // cap just put on
sgetz7908 26:a577c4b69fe0 384 debug("EOL Cap On \n");
sgetz7908 26:a577c4b69fe0 385 set_radio(true);
sgetz7908 27:bb7247a1704e 386 state = EOL_WAIT_CAP_OFF;
sgetz7908 26:a577c4b69fe0 387 }
sgetz7908 26:a577c4b69fe0 388 break;
sgetz7908 29:4b347695b9f7 389 /*
sgetz7908 26:a577c4b69fe0 390 case EOL_WAIT_LIGHT: // EOL and its dark, save power
sgetz7908 26:a577c4b69fe0 391 // set up and enable the Light Sense Interrupt
sgetz7908 26:a577c4b69fe0 392 // go to lowest power state
sgetz7908 27:bb7247a1704e 393
sgetz7908 26:a577c4b69fe0 394 debug("Going to EOL dark mode\n");
sgetz7908 26:a577c4b69fe0 395 led = 0;
sgetz7908 27:bb7247a1704e 396 if(is_package_open)
sgetz7908 27:bb7247a1704e 397 {
sgetz7908 27:bb7247a1704e 398 start_periodic_tick(PERIODIC_TICK_SEC);
sgetz7908 27:bb7247a1704e 399 state = EOL_WAIT_CAP_OFF;
sgetz7908 27:bb7247a1704e 400 }
sgetz7908 26:a577c4b69fe0 401 break;
sgetz7908 29:4b347695b9f7 402 */
sgetz7908 24:761c30334cf4 403 default: // illegal state
sgetz7908 24:761c30334cf4 404 state = INIT;
sgetz7908 23:7ca590427f0e 405 break;
sgetz7908 23:7ca590427f0e 406 }
sgetz7908 24:761c30334cf4 407 } while(state != last_state);
sgetz7908 23:7ca590427f0e 408 }
sgetz7908 23:7ca590427f0e 409
sgetz7908 27:bb7247a1704e 410 void dataWasRead(void)
sgetz7908 27:bb7247a1704e 411 {
sgetz7908 27:bb7247a1704e 412 flash_led(1, 0.04);
sgetz7908 27:bb7247a1704e 413 }
sgetz7908 27:bb7247a1704e 414
sgetz7908 24:761c30334cf4 415 /// process commands sent to the SmartCap over Bluetooth UART
sgetz7908 23:7ca590427f0e 416 void process_cmd(char * cmd)
sgetz7908 23:7ca590427f0e 417 {
sgetz7908 23:7ca590427f0e 418 switch(tolower(cmd[0])) {
sgetz7908 23:7ca590427f0e 419 case 'r': // Get records
sgetz7908 23:7ca590427f0e 420 log_show();
sgetz7908 23:7ca590427f0e 421 //batt_voltage = read_battery_voltage();
sgetz7908 23:7ca590427f0e 422 //updateBattValue(batt_voltage);
sgetz7908 23:7ca590427f0e 423 break;
sgetz7908 23:7ca590427f0e 424
sgetz7908 23:7ca590427f0e 425 case 's': // status
sgetz7908 23:7ca590427f0e 426 switch(tolower(cmd[1])) {
sgetz7908 23:7ca590427f0e 427 case 0: // old, check battery voltage
sgetz7908 23:7ca590427f0e 428 batt_voltage = read_battery_voltage();
sgetz7908 23:7ca590427f0e 429 BLE_UART_xmit("Bat=");
sgetz7908 23:7ca590427f0e 430 BLE_UART_xmit(batt_voltage);
sgetz7908 23:7ca590427f0e 431 BLE_UART_xmit("\n");
sgetz7908 23:7ca590427f0e 432 break;
sgetz7908 23:7ca590427f0e 433
sgetz7908 26:a577c4b69fe0 434 //case 'x': // checksum
sgetz7908 26:a577c4b69fe0 435 // BLE_UART_xmit("sx=");
sgetz7908 26:a577c4b69fe0 436 // BLE_UART_xmit(0);
sgetz7908 26:a577c4b69fe0 437 // BLE_UART_xmit("\n");
sgetz7908 26:a577c4b69fe0 438 // break;
sgetz7908 25:42163d650266 439
sgetz7908 24:761c30334cf4 440 case 'c': // cap sensor analog readings
sgetz7908 24:761c30334cf4 441 BLE_UART_xmit("sc=");
sgetz7908 24:761c30334cf4 442 test_cap();
sgetz7908 24:761c30334cf4 443 BLE_UART_xmit(on_reading);
sgetz7908 24:761c30334cf4 444 BLE_UART_xmit(",");
sgetz7908 24:761c30334cf4 445 BLE_UART_xmit(off_reading);
sgetz7908 24:761c30334cf4 446 BLE_UART_xmit("\n");
sgetz7908 24:761c30334cf4 447 break;
sgetz7908 26:a577c4b69fe0 448
sgetz7908 26:a577c4b69fe0 449 case 'm': // CRC of Softdevice and App (Not including NV storage for logs and flags)
sgetz7908 26:a577c4b69fe0 450 {
sgetz7908 26:a577c4b69fe0 451 uint16_t crc = crc16((const unsigned char*)CRC_START_ADDR, (uint32_t)(CRC_END_ADDR - CRC_START_ADDR + 1) );
sgetz7908 34:c122d842ad9a 452 BLE_UART_xmit("sm=");
sgetz7908 26:a577c4b69fe0 453 BLE_UART_xmit(char2hex(crc, 4));
sgetz7908 26:a577c4b69fe0 454 BLE_UART_xmit("\n");
sgetz7908 26:a577c4b69fe0 455 }
sgetz7908 26:a577c4b69fe0 456 break;
sgetz7908 23:7ca590427f0e 457
sgetz7908 26:a577c4b69fe0 458 case 's': // sensors as binary, with bits '000eutcp', e=(0=EOL), u=(0=in use), t=(1=TESTING REQUIRED), c=(1 is cap off), p=(1 is light sensed)
sgetz7908 25:42163d650266 459 //int val = 0;
sgetz7908 27:bb7247a1704e 460 BLE_UART_xmit("*ss=000");
sgetz7908 26:a577c4b69fe0 461 if(NV_NOT_EOL) BLE_UART_xmit("1"); else BLE_UART_xmit("0");
sgetz7908 26:a577c4b69fe0 462 if(NV_NOT_IN_USE) BLE_UART_xmit("1"); else BLE_UART_xmit("0");
sgetz7908 25:42163d650266 463 if(NV_TESTING_REQUIRED) BLE_UART_xmit("1"); else BLE_UART_xmit("0");
sgetz7908 25:42163d650266 464 int save = package_open_sense_enable;
sgetz7908 24:761c30334cf4 465 package_open_sense_enable = 1;
sgetz7908 24:761c30334cf4 466 test_cap();
sgetz7908 25:42163d650266 467 if(is_cap_off) BLE_UART_xmit("1"); else BLE_UART_xmit("0");
sgetz7908 25:42163d650266 468 if(is_package_open) BLE_UART_xmit("1"); else BLE_UART_xmit("0");
sgetz7908 25:42163d650266 469 package_open_sense_enable = save;
sgetz7908 23:7ca590427f0e 470 BLE_UART_xmit("\n");
sgetz7908 23:7ca590427f0e 471 break;
sgetz7908 26:a577c4b69fe0 472
sgetz7908 23:7ca590427f0e 473 }
sgetz7908 23:7ca590427f0e 474 break;
sgetz7908 24:761c30334cf4 475 case 'p': // test passed
sgetz7908 24:761c30334cf4 476 if(tolower(cmd[1])=='z')
sgetz7908 24:761c30334cf4 477 {
sgetz7908 24:761c30334cf4 478 log_add(EVENT_TEST_PASS, 0, 0, 0);
sgetz7908 26:a577c4b69fe0 479 if(NV_TESTING_REQUIRED) nv_clear(NV_TESTING_REQUIRED_ADDR);
sgetz7908 24:761c30334cf4 480 }
sgetz7908 26:a577c4b69fe0 481
sgetz7908 24:761c30334cf4 482 break;
sgetz7908 24:761c30334cf4 483
sgetz7908 23:7ca590427f0e 484 case 't': // get time
sgetz7908 23:7ca590427f0e 485 BLE_UART_xmit(read_clock());
sgetz7908 23:7ca590427f0e 486 BLE_UART_xmit("\n");
sgetz7908 23:7ca590427f0e 487 break;
sgetz7908 23:7ca590427f0e 488
sgetz7908 23:7ca590427f0e 489 case 'c': // set time
sgetz7908 23:7ca590427f0e 490 {
sgetz7908 23:7ca590427f0e 491 int i = 1;
sgetz7908 23:7ca590427f0e 492 uint32_t num = 0;
sgetz7908 23:7ca590427f0e 493
sgetz7908 23:7ca590427f0e 494 while(cmd[i]>='0' && cmd[i]<='9') {
sgetz7908 23:7ca590427f0e 495 num = num*10 + cmd[i++]-'0';
sgetz7908 23:7ca590427f0e 496 }
sgetz7908 23:7ca590427f0e 497
sgetz7908 23:7ca590427f0e 498 if(i>1) {
sgetz7908 23:7ca590427f0e 499 set_time_offset(num);
sgetz7908 23:7ca590427f0e 500 BLE_UART_xmit("*Time Set\n");
sgetz7908 23:7ca590427f0e 501 }
sgetz7908 23:7ca590427f0e 502 }
sgetz7908 23:7ca590427f0e 503 break;
sgetz7908 30:76b51e525c40 504
sgetz7908 23:7ca590427f0e 505 case 'v': // version
sgetz7908 24:761c30334cf4 506 BLE_UART_xmit("v=");
sgetz7908 23:7ca590427f0e 507 BLE_UART_xmit(FW_VERSION);
sgetz7908 23:7ca590427f0e 508 BLE_UART_xmit("\n");
sgetz7908 23:7ca590427f0e 509 break;
sgetz7908 23:7ca590427f0e 510
sgetz7908 23:7ca590427f0e 511 default:
sgetz7908 23:7ca590427f0e 512 BLE_UART_xmit("S=Status\n");
sgetz7908 23:7ca590427f0e 513 break;
sgetz7908 23:7ca590427f0e 514 }
sgetz7908 23:7ca590427f0e 515 cmd[0] = 0;
sgetz7908 23:7ca590427f0e 516 }
sgetz7908 25:42163d650266 517
sgetz7908 25:42163d650266 518 //*****************************************************************************
sgetz7908 25:42163d650266 519
sgetz7908 25:42163d650266 520 int main(void)
sgetz7908 25:42163d650266 521 {
sgetz7908 25:42163d650266 522 // blink LED to indicate power applied
sgetz7908 25:42163d650266 523 //flash_led(1,1.0);
sgetz7908 25:42163d650266 524
sgetz7908 25:42163d650266 525 if(Init_BLE_Stuff()) // init and start advertising
sgetz7908 25:42163d650266 526 {
sgetz7908 25:42163d650266 527 flash_led(0, 0.05); // indicate a ble init error
sgetz7908 25:42163d650266 528 }
sgetz7908 25:42163d650266 529
sgetz7908 25:42163d650266 530 eventQueue.call(process_state);
sgetz7908 25:42163d650266 531
sgetz7908 25:42163d650266 532 eventQueue.dispatch_forever(); // run all tasks in the event queue (non-interrupt routines)
sgetz7908 25:42163d650266 533 return 0;
sgetz7908 25:42163d650266 534 }
sgetz7908 25:42163d650266 535
sgetz7908 25:42163d650266 536