Bob Giesberts / Mbed 2 deprecated Inductive_Sensor_3

Version 3.0: Switching to newer LDC1614 which is placed on the same PCB.

Dependencies:   Bob DS1825 LDC1614 LDC1101 SDFileSystem mbed

Fork of Inductive_Sensor by Bob Giesberts

main.cpp@21:b96a3de88002, 2016-09-21 (annotated)

Committer:
bobgiesberts
Date:
Wed Sep 21 14:26:45 2016 +0000
Revision:
21:b96a3de88002
Parent:
20:1c5ea04a3b2a
Child:
22:ac26f52ebaf8
Thermometer works properly now, ; Multiple sensors work properly now, ; Better catching of errors.;

Who changed what in which revision?

UserRevisionLine numberNew contents of line
bobgiesberts 2:1a203732fc95 1 /**
bobgiesberts 2:1a203732fc95 2 * @file main.cpp
bobgiesberts 2:1a203732fc95 3 * @brief This file programs the processor for the inductive force sensor
bobgiesberts 15:5de8394fdb3c 4 * using the library LDC1614.h and LDC1614.cpp.
bobgiesberts 15:5de8394fdb3c 5 * - Green Led: processing communication with LDC1614
bobgiesberts 15:5de8394fdb3c 6 * - Red Led: error
bobgiesberts 10:3cab80866536 7 *
bobgiesberts 4:ae441c5727b9 8 * Log protocol:
bobgiesberts 15:5de8394fdb3c 9 * - 0:30 minutes at 13 Hz
bobgiesberts 13:2caedc56b863 10 * - 14:30 minutes rest
bobgiesberts 2:1a203732fc95 11 *
bobgiesberts 2:1a203732fc95 12 * @author Bob Giesberts
bobgiesberts 2:1a203732fc95 13 *
bobgiesberts 15:5de8394fdb3c 14 * @date 2016-08-23
bobgiesberts 2:1a203732fc95 15 */
bobgiesberts 10:3cab80866536 16 #include "mbed.h"
bobgiesberts 15:5de8394fdb3c 17 #include "LDC1614.h" // inductive force sensor
bobgiesberts 11:599ca9982e45 18 #include "SDFileSystem.h" // control the SD card
bobgiesberts 11:599ca9982e45 19 #include "Bob.h" // processorboard
bobgiesberts 11:599ca9982e45 20 #include "DS1825.h" // thermometer
bobgiesberts 10:3cab80866536 21
bobgiesberts 10:3cab80866536 22 #include <iostream>
bobgiesberts 10:3cab80866536 23 #include <vector>
bobgiesberts 10:3cab80866536 24 #include <string>
bobgiesberts 10:3cab80866536 25 using namespace std;
bobgiesberts 10:3cab80866536 26
bobgiesberts 17:a4700b1c3c37 27
bobgiesberts 17:a4700b1c3c37 28
bobgiesberts 20:1c5ea04a3b2a 29 bool DEBUG = false;
bobgiesberts 21:b96a3de88002 30 // Serial pc( USBTX, USBRX );
bobgiesberts 17:a4700b1c3c37 31
bobgiesberts 17:a4700b1c3c37 32
bobgiesberts 5:736a81a59f3c 33 // SETTINGS
bobgiesberts 21:b96a3de88002 34 uint8_t C = 120; // Capacitor (in pF)
bobgiesberts 21:b96a3de88002 35 uint8_t f_CLKIN = 40; // Oscillator frequency (in MHz)
bobgiesberts 21:b96a3de88002 36 const uint8_t sensors = 2; // number of attached sensors
bobgiesberts 21:b96a3de88002 37
bobgiesberts 21:b96a3de88002 38 uint16_t INTERVAL_FIRST = 900; // First sampling time in seconds. 60:00 minutes = 3600 sec
bobgiesberts 12:cceece4f3afb 39 uint16_t INTERVAL_OFF = 870; // Waiting interval in seconds. 14:30 minutes = 870 sec (14*60+30)
bobgiesberts 12:cceece4f3afb 40 uint16_t INTERVAL_ON = 30; // Sampling interval in seconds. 0:30 minutes = 30 sec
bobgiesberts 12:cceece4f3afb 41
bobgiesberts 15:5de8394fdb3c 42 // Leds
bobgiesberts 20:1c5ea04a3b2a 43 PinName _LED_PROCESS = PTB0; // Green led
bobgiesberts 20:1c5ea04a3b2a 44 PinName _LED_ERROR = PTB1; // Red led
bobgiesberts 15:5de8394fdb3c 45
bobgiesberts 15:5de8394fdb3c 46 // Thermometer
bobgiesberts 15:5de8394fdb3c 47 PinName _Tpin = PTC1; // OneWire system (PTB1 for the first sensor) // old = PTB0, new: PTC1
bobgiesberts 15:5de8394fdb3c 48
bobgiesberts 15:5de8394fdb3c 49 // LDC1614
bobgiesberts 15:5de8394fdb3c 50 PinName _LDC_SDA = PTC5; // I2C: SDA
bobgiesberts 15:5de8394fdb3c 51 PinName _LDC_SCL = PTC4; // I2C: SCL
bobgiesberts 15:5de8394fdb3c 52 PinName _LDC_SD = PTC6; // Shutdown
bobgiesberts 15:5de8394fdb3c 53
bobgiesberts 15:5de8394fdb3c 54 // SD File system
bobgiesberts 15:5de8394fdb3c 55 PinName _SD_PRESENT = PTE0; // card detect // old = new: PTE0
bobgiesberts 15:5de8394fdb3c 56 PinName _SD_MOSI = PTD6; // mosi // old = new: PTD6
bobgiesberts 15:5de8394fdb3c 57 PinName _SD_MISO = PTD7; // miso // old = new: PTD7
bobgiesberts 15:5de8394fdb3c 58 PinName _SD_SCLK = PTD5; // sclk // old = new: PTD5
bobgiesberts 15:5de8394fdb3c 59 PinName _SD_CS = PTD4; // cs // old = new: PTD4
bobgiesberts 15:5de8394fdb3c 60
bobgiesberts 15:5de8394fdb3c 61 // Other components
bobgiesberts 17:a4700b1c3c37 62 PinName _ENABLE = PTC3; // enables SD card and Crystal
bobgiesberts 15:5de8394fdb3c 63 PinName _BATTERY = PTC2; // voltage // old = new: PTC2
bobgiesberts 15:5de8394fdb3c 64 PinName _BUTTON = PTA4;
bobgiesberts 12:cceece4f3afb 65
bobgiesberts 0:e81b68888268 66
bobgiesberts 5:736a81a59f3c 67 // load libraries
bobgiesberts 17:a4700b1c3c37 68 Bob bob( _LED_PROCESS, _LED_ERROR, _BUTTON, _ENABLE, _SD_PRESENT, _BATTERY );
bobgiesberts 21:b96a3de88002 69 // Serial pc( USBTX, USBRX );
bobgiesberts 4:ae441c5727b9 70
bobgiesberts 4:ae441c5727b9 71 // timer variables
bobgiesberts 6:ff39d60061ca 72 uint32_t now = 0, next = 0, prev = 0;
bobgiesberts 8:8cc1960467ae 73 uint8_t t_high = 0;
bobgiesberts 11:599ca9982e45 74 uint32_t t_lost = 0, lost_prev = 0;
bobgiesberts 8:8cc1960467ae 75 uint8_t lost_high = 0;
bobgiesberts 11:599ca9982e45 76 uint32_t t_sleep = 0;
bobgiesberts 12:cceece4f3afb 77 uint32_t t;
bobgiesberts 4:ae441c5727b9 78
bobgiesberts 4:ae441c5727b9 79 // file variables
bobgiesberts 4:ae441c5727b9 80 FILE *fp;
bobgiesberts 4:ae441c5727b9 81 string filename = "/sd/data00.txt";
bobgiesberts 4:ae441c5727b9 82 const char *fn;
bobgiesberts 4:ae441c5727b9 83
bobgiesberts 11:599ca9982e45 84 // temperature variables
bobgiesberts 11:599ca9982e45 85 float T;
bobgiesberts 11:599ca9982e45 86
bobgiesberts 21:b96a3de88002 87 // LDC variables
bobgiesberts 21:b96a3de88002 88 uint32_t L;
bobgiesberts 21:b96a3de88002 89
bobgiesberts 5:736a81a59f3c 90 // temporal storage for data samples
bobgiesberts 21:b96a3de88002 91 const uint8_t package_size = 60; // ±12-13 Hz, so 60 would take about 5 sec.
bobgiesberts 12:cceece4f3afb 92 struct mydata {
bobgiesberts 21:b96a3de88002 93 uint32_t t[package_size]; // time (s)
bobgiesberts 21:b96a3de88002 94 uint32_t L[sensors][package_size]; // LHR_DATA
bobgiesberts 12:cceece4f3afb 95 } collected;
bobgiesberts 12:cceece4f3afb 96 uint8_t counter = 0;
bobgiesberts 21:b96a3de88002 97 uint8_t SKIPPING = 3;
bobgiesberts 21:b96a3de88002 98 uint8_t skip = 0;
bobgiesberts 12:cceece4f3afb 99
bobgiesberts 12:cceece4f3afb 100 // function to write all data to the SD card
bobgiesberts 12:cceece4f3afb 101 void storeit( float T )
bobgiesberts 12:cceece4f3afb 102 {
bobgiesberts 13:2caedc56b863 103 // TODO: writing to SD card more efficient!
bobgiesberts 13:2caedc56b863 104 // t 32-bit | 0.00 2000000.00 3-10x8-bit | FFFFFFFF 8x8
bobgiesberts 13:2caedc56b863 105 // L 24-bit | 0 1677216 6- 7x8-bit | FFFFFF 6x8
bobgiesberts 13:2caedc56b863 106 // V 8-bit | 3.10 4.20 4x8-bit | FF 2x8
bobgiesberts 13:2caedc56b863 107 // T 16-bit | -20.0000 85.0000 7x8-bit | FFFF 4x8
bobgiesberts 20:1c5ea04a3b2a 108
bobgiesberts 21:b96a3de88002 109
bobgiesberts 21:b96a3de88002 110 bob.processing();
bobgiesberts 21:b96a3de88002 111
bobgiesberts 12:cceece4f3afb 112 // write data to SD card
bobgiesberts 12:cceece4f3afb 113 fp = fopen( fn, "a" ); // open file (append)
bobgiesberts 12:cceece4f3afb 114 for( int i = 0; i < counter; i++ )
bobgiesberts 21:b96a3de88002 115 {
bobgiesberts 21:b96a3de88002 116 fprintf( fp, "%.2f;", (float) collected.t[i]/100.0); // write to file
bobgiesberts 21:b96a3de88002 117 for(int sensor = 0; sensor < sensors; sensor++)
bobgiesberts 21:b96a3de88002 118 fprintf( fp, "%d;", collected.L[sensor][i]); // write to file
bobgiesberts 21:b96a3de88002 119 fprintf( fp, "%.2f;%.4f\r\n", bob.battery(), T ); // write to file
bobgiesberts 21:b96a3de88002 120 }
bobgiesberts 12:cceece4f3afb 121 fclose( fp ); // close file
bobgiesberts 13:2caedc56b863 122
bobgiesberts 13:2caedc56b863 123 // write to screen
bobgiesberts 21:b96a3de88002 124 // pc.printf( "%.2f;", (float) collected.t[counter-1]/100.0); // write to file
bobgiesberts 21:b96a3de88002 125 // for(int sensor = 0; sensor < sensors; sensor++)
bobgiesberts 21:b96a3de88002 126 // pc.printf( "%d;", collected.L[sensor][counter-1]); // write to file
bobgiesberts 21:b96a3de88002 127 // pc.printf( "%.2f;%.4f\r\n", bob.battery(), T ); // write to file
bobgiesberts 13:2caedc56b863 128
bobgiesberts 17:a4700b1c3c37 129 bob.no_processing();
bobgiesberts 12:cceece4f3afb 130
bobgiesberts 12:cceece4f3afb 131 // Reset data
bobgiesberts 12:cceece4f3afb 132 memset(collected.t, 0, counter);
bobgiesberts 12:cceece4f3afb 133 memset(collected.L, 0, counter);
bobgiesberts 12:cceece4f3afb 134 counter = 0;
bobgiesberts 12:cceece4f3afb 135 }
bobgiesberts 5:736a81a59f3c 136
bobgiesberts 10:3cab80866536 137 int main(void)
bobgiesberts 10:3cab80866536 138 {
bobgiesberts 21:b96a3de88002 139 if( DEBUG )
bobgiesberts 21:b96a3de88002 140 {
bobgiesberts 21:b96a3de88002 141 Serial pc( USBTX, USBRX );
bobgiesberts 21:b96a3de88002 142 bob.wakeup_periphery( );
bobgiesberts 21:b96a3de88002 143 LDC1614 ldc( _LDC_SDA, _LDC_SCL, _LDC_SD, f_CLKIN, sensors, C );
bobgiesberts 21:b96a3de88002 144 DS1825 thermometer( _Tpin );
bobgiesberts 21:b96a3de88002 145
bobgiesberts 21:b96a3de88002 146 while( 1 ) {
bobgiesberts 21:b96a3de88002 147
bobgiesberts 21:b96a3de88002 148 prev = now;
bobgiesberts 21:b96a3de88002 149 now = (uint32_t) clock();
bobgiesberts 21:b96a3de88002 150
bobgiesberts 21:b96a3de88002 151 bob.processing();
bobgiesberts 21:b96a3de88002 152 for(int sensor = 0; sensor < sensors; sensor++)
bobgiesberts 21:b96a3de88002 153 {
bobgiesberts 21:b96a3de88002 154 // wait for a new conversion to be ready
bobgiesberts 21:b96a3de88002 155 while( !ldc.is_ready( sensor ) ) { }
bobgiesberts 21:b96a3de88002 156
bobgiesberts 21:b96a3de88002 157 // write to screen
bobgiesberts 21:b96a3de88002 158 L = ldc.get_Data( sensor );
bobgiesberts 21:b96a3de88002 159 if ( !ldc.get_error( sensor ) )
bobgiesberts 21:b96a3de88002 160 {
bobgiesberts 21:b96a3de88002 161 pc.printf( "[%.2f Hz] 0x%08X, %.6f MHz, Vbatt = %.2f V, T = %.2f C\r\n", 1/((now-prev)/100.0), L, ldc.get_fsensor( L )/1000000, bob.battery(), thermometer.getTemperature() );
bobgiesberts 21:b96a3de88002 162 bob.no_error();
bobgiesberts 21:b96a3de88002 163 }else{
bobgiesberts 21:b96a3de88002 164 bob.error();
bobgiesberts 21:b96a3de88002 165 }
bobgiesberts 21:b96a3de88002 166 }
bobgiesberts 21:b96a3de88002 167 bob.no_processing();
bobgiesberts 21:b96a3de88002 168 }
bobgiesberts 21:b96a3de88002 169 }
bobgiesberts 21:b96a3de88002 170
bobgiesberts 21:b96a3de88002 171
bobgiesberts 13:2caedc56b863 172
bobgiesberts 13:2caedc56b863 173 // TODO:
bobgiesberts 13:2caedc56b863 174 // - implement this data conversion in writing to SD!!
bobgiesberts 13:2caedc56b863 175 // - use T as uint16_t, not float!
bobgiesberts 13:2caedc56b863 176 // - use V as uint16_t, not float!
bobgiesberts 13:2caedc56b863 177 // - write blocks of 512 bit (4x 32 + 32 + 16 + 16)
bobgiesberts 13:2caedc56b863 178 //
bobgiesberts 13:2caedc56b863 179 // float temp_a = 127.9375;
bobgiesberts 13:2caedc56b863 180 // pc.printf( "A: %.4f (%08x); \r\n", temp_a, * (uint32_t *) &temp_a);
bobgiesberts 13:2caedc56b863 181
bobgiesberts 6:ff39d60061ca 182 // Load SD File system
bobgiesberts 12:cceece4f3afb 183 // - the Raspberry Pie SD cards give a warning here that might just be ignored:
bobgiesberts 12:cceece4f3afb 184 // "Not in idle state after sending CMD8 (not an SD card?)
bobgiesberts 12:cceece4f3afb 185 // Didn't get a response from the disk
bobgiesberts 12:cceece4f3afb 186 // Set 512-byte block timed out"
bobgiesberts 12:cceece4f3afb 187 // TODO: buy 'better' SD cards from IAPC / the Stores (Kingston ...)
bobgiesberts 17:a4700b1c3c37 188
bobgiesberts 17:a4700b1c3c37 189 // This turns enable on, i.e. it powers the SD card system, the crystal and the LDC
bobgiesberts 17:a4700b1c3c37 190 bob.wakeup_periphery();
bobgiesberts 17:a4700b1c3c37 191
bobgiesberts 21:b96a3de88002 192 // check if both leds work
bobgiesberts 21:b96a3de88002 193 bob.flash( 1 );
bobgiesberts 21:b96a3de88002 194
bobgiesberts 17:a4700b1c3c37 195 // load SD File System
bobgiesberts 15:5de8394fdb3c 196 SDFileSystem *sd = new SDFileSystem( _SD_MOSI, _SD_MISO, _SD_SCLK, _SD_CS, "sd" );
bobgiesberts 10:3cab80866536 197
bobgiesberts 6:ff39d60061ca 198 // Create a new data file (data00.txt)
bobgiesberts 10:3cab80866536 199 mkdir("/sd", 0777);
bobgiesberts 11:599ca9982e45 200 for(uint8_t i = 0; i < 100; i++)
bobgiesberts 11:599ca9982e45 201 {
bobgiesberts 6:ff39d60061ca 202 filename[8] = i/10 + '0';
bobgiesberts 4:ae441c5727b9 203 filename[9] = i%10 + '0';
bobgiesberts 4:ae441c5727b9 204 fp = fopen( filename.c_str() , "r" );
bobgiesberts 11:599ca9982e45 205 if( fp == NULL ) // read failed so file does not exist
bobgiesberts 11:599ca9982e45 206 {
bobgiesberts 4:ae441c5727b9 207 fp = fopen( filename.c_str(), "w" ); // create it
bobgiesberts 11:599ca9982e45 208 if( fp != NULL )
bobgiesberts 11:599ca9982e45 209 {
bobgiesberts 4:ae441c5727b9 210 fn = filename.c_str();
bobgiesberts 6:ff39d60061ca 211 fclose( fp );
bobgiesberts 21:b96a3de88002 212 bob.processing( 1 );
bobgiesberts 4:ae441c5727b9 213 break;
bobgiesberts 10:3cab80866536 214 } else {
bobgiesberts 21:b96a3de88002 215 bob.error( 3 ); // error: unable to create new file
bobgiesberts 4:ae441c5727b9 216 }
bobgiesberts 10:3cab80866536 217 } else { // file already exists
bobgiesberts 4:ae441c5727b9 218 fclose( fp );
bobgiesberts 4:ae441c5727b9 219 }
bobgiesberts 21:b96a3de88002 220 }
bobgiesberts 11:599ca9982e45 221 if( fp == NULL )
bobgiesberts 11:599ca9982e45 222 {
bobgiesberts 21:b96a3de88002 223 // THIS ERROR IS NOT CATCHED PROPERLY!!!
bobgiesberts 21:b96a3de88002 224 bob.error( 4 ); // error: file 00 - 99 already exists
bobgiesberts 11:599ca9982e45 225 }
bobgiesberts 10:3cab80866536 226
bobgiesberts 6:ff39d60061ca 227 // Unload SD File system
bobgiesberts 10:3cab80866536 228 delete sd;
bobgiesberts 10:3cab80866536 229 sd = NULL;
bobgiesberts 17:a4700b1c3c37 230
bobgiesberts 21:b96a3de88002 231
bobgiesberts 21:b96a3de88002 232 // LDC1614 *ldc = new LDC1614(_LDC_SDA, _LDC_SCL, _LDC_SD, f_CLKIN, sensors, C); // load LDC1614 libray
bobgiesberts 12:cceece4f3afb 233
bobgiesberts 11:599ca9982e45 234 while(1)
bobgiesberts 11:599ca9982e45 235 {
bobgiesberts 11:599ca9982e45 236 // what time is it now?
bobgiesberts 8:8cc1960467ae 237 prev = now; // 0 -> 429 496 --> (4 294,96 s) (71 min)
bobgiesberts 8:8cc1960467ae 238 now = (uint32_t) clock(); // 0 -> 429 496 --> (4 294,96 s) (71 min)
bobgiesberts 11:599ca9982e45 239 if( now < prev )
bobgiesberts 11:599ca9982e45 240 t_high++; // 0 -> 255 --> (255*4 294,96 s) (12 days)
bobgiesberts 11:599ca9982e45 241 t = now + 429496.7296*t_high + t_lost + 429496.7296*lost_high; // 0 -> 219 901 952 --> (2 199 019,52 s) (25 days)
bobgiesberts 17:a4700b1c3c37 242
bobgiesberts 17:a4700b1c3c37 243 // How long should we takes samples?
bobgiesberts 17:a4700b1c3c37 244 next = t + ( (next == 0) ? INTERVAL_FIRST : INTERVAL_ON )*100; // 0 -> 219 904 952 --> (2 199 049,52 s) (25 days)
bobgiesberts 17:a4700b1c3c37 245
bobgiesberts 17:a4700b1c3c37 246
bobgiesberts 21:b96a3de88002 247 // Wakeup the periphery (3v3 on. Powers SD, crystal and LDC1614)
bobgiesberts 17:a4700b1c3c37 248 bob.wakeup_periphery();
bobgiesberts 11:599ca9982e45 249
bobgiesberts 15:5de8394fdb3c 250 // load libraries to take control over the communication
bobgiesberts 21:b96a3de88002 251 LDC1614 *ldc = new LDC1614(_LDC_SDA, _LDC_SCL, _LDC_SD, f_CLKIN, sensors, C); // load LDC1614 libray
bobgiesberts 21:b96a3de88002 252 DS1825 *thermometer = new DS1825( _Tpin ); // load thermometer (DS1825) library
bobgiesberts 21:b96a3de88002 253 SDFileSystem *sd = new SDFileSystem(_SD_MOSI, _SD_MISO, _SD_SCLK, _SD_CS, "sd"); // load SD File System library
bobgiesberts 11:599ca9982e45 254 mkdir("/sd", 0777); // select folder
bobgiesberts 10:3cab80866536 255
bobgiesberts 6:ff39d60061ca 256 // Take samples for INTERVAL_ON seconds
bobgiesberts 11:599ca9982e45 257 while( t < next )
bobgiesberts 11:599ca9982e45 258 {
bobgiesberts 12:cceece4f3afb 259 // what time is it now?
bobgiesberts 12:cceece4f3afb 260 prev = now;
bobgiesberts 12:cceece4f3afb 261 now = (uint32_t) clock();
bobgiesberts 12:cceece4f3afb 262 if( now < prev )
bobgiesberts 12:cceece4f3afb 263 t_high++;
bobgiesberts 12:cceece4f3afb 264 t = now + 429496.7296*t_high + t_lost + 429496.7296*lost_high;
bobgiesberts 10:3cab80866536 265
bobgiesberts 21:b96a3de88002 266 // assess all sensors
bobgiesberts 21:b96a3de88002 267 for ( int sensor = 0; sensor < sensors; sensor++ )
bobgiesberts 21:b96a3de88002 268 {
bobgiesberts 21:b96a3de88002 269 // wait for a new conversion to be ready
bobgiesberts 21:b96a3de88002 270 while( !ldc->is_ready( sensor ) ) { }
bobgiesberts 21:b96a3de88002 271
bobgiesberts 21:b96a3de88002 272 // collect data
bobgiesberts 21:b96a3de88002 273 L = ldc->get_Data( sensor );
bobgiesberts 21:b96a3de88002 274
bobgiesberts 21:b96a3de88002 275 // catch errors (sensor broken / not connected)
bobgiesberts 21:b96a3de88002 276 if ( !ldc->get_error( sensor ) )
bobgiesberts 21:b96a3de88002 277 {
bobgiesberts 21:b96a3de88002 278 // skip the first few measurements (they are too low)
bobgiesberts 21:b96a3de88002 279 if ( skip >= SKIPPING )
bobgiesberts 21:b96a3de88002 280 {
bobgiesberts 21:b96a3de88002 281 // store data
bobgiesberts 21:b96a3de88002 282 collected.L[sensor][counter] = L;
bobgiesberts 20:1c5ea04a3b2a 283
bobgiesberts 21:b96a3de88002 284 // only store the time once
bobgiesberts 21:b96a3de88002 285 if ( sensor == 0 )
bobgiesberts 21:b96a3de88002 286 {
bobgiesberts 21:b96a3de88002 287 collected.t[counter] = t;
bobgiesberts 21:b96a3de88002 288 counter++;
bobgiesberts 21:b96a3de88002 289 }
bobgiesberts 21:b96a3de88002 290 }else{
bobgiesberts 21:b96a3de88002 291 skip++;
bobgiesberts 21:b96a3de88002 292 }
bobgiesberts 21:b96a3de88002 293 }else{
bobgiesberts 21:b96a3de88002 294 bob.error();
bobgiesberts 21:b96a3de88002 295 }
bobgiesberts 21:b96a3de88002 296 }
bobgiesberts 15:5de8394fdb3c 297
bobgiesberts 20:1c5ea04a3b2a 298 // Write a full package of data points to the SD card
bobgiesberts 20:1c5ea04a3b2a 299 if( counter >= package_size-1 )
bobgiesberts 20:1c5ea04a3b2a 300 {
bobgiesberts 21:b96a3de88002 301 storeit( thermometer->getTemperature() );
bobgiesberts 6:ff39d60061ca 302 }
bobgiesberts 21:b96a3de88002 303
bobgiesberts 21:b96a3de88002 304 bob.no_error();
bobgiesberts 10:3cab80866536 305 }
bobgiesberts 21:b96a3de88002 306 skip = 0;
bobgiesberts 12:cceece4f3afb 307
bobgiesberts 12:cceece4f3afb 308 // Write remaining data to the SD card
bobgiesberts 12:cceece4f3afb 309 if( counter > 0 )
bobgiesberts 20:1c5ea04a3b2a 310 {
bobgiesberts 21:b96a3de88002 311 storeit( thermometer->getTemperature() );
bobgiesberts 20:1c5ea04a3b2a 312 }
bobgiesberts 10:3cab80866536 313
bobgiesberts 17:a4700b1c3c37 314 // prepare for sleep: delete and power down the periphery (SD, crystal and LDC1614)
bobgiesberts 21:b96a3de88002 315 ldc->shutdown(); // _LDC_SD --> 1
bobgiesberts 21:b96a3de88002 316 bob.shutdown_periphery(); // 3V3 --> 0
bobgiesberts 21:b96a3de88002 317
bobgiesberts 21:b96a3de88002 318 // LDC I2C
bobgiesberts 12:cceece4f3afb 319 delete ldc; ldc = NULL; // unload library to be able to power down completely
bobgiesberts 21:b96a3de88002 320 bob.shutdown_pin( _LDC_SDA );
bobgiesberts 21:b96a3de88002 321 bob.shutdown_pin( _LDC_SCL );
bobgiesberts 21:b96a3de88002 322 bob.shutdown_pin( _LDC_SD );
bobgiesberts 21:b96a3de88002 323
bobgiesberts 21:b96a3de88002 324 // SD SPI
bobgiesberts 21:b96a3de88002 325 delete sd; sd = NULL; // unload library to be able to power down completely
bobgiesberts 21:b96a3de88002 326 bob.shutdown_pin( _SD_PRESENT );
bobgiesberts 21:b96a3de88002 327 bob.shutdown_pin( _SD_CS );
bobgiesberts 21:b96a3de88002 328 bob.shutdown_pin( _SD_MOSI );
bobgiesberts 21:b96a3de88002 329 bob.shutdown_pin( _SD_SCLK );
bobgiesberts 21:b96a3de88002 330 bob.shutdown_pin( _SD_MISO );
bobgiesberts 21:b96a3de88002 331
bobgiesberts 21:b96a3de88002 332 // PC ports (SWD / UARTO)
bobgiesberts 21:b96a3de88002 333 bob.shutdown_pin( PTA0 ); // SWD_CLK
bobgiesberts 21:b96a3de88002 334 bob.shutdown_pin( PTA1 ); // UARTO_RX
bobgiesberts 21:b96a3de88002 335 bob.shutdown_pin( PTA2 ); // UARTO_TX
bobgiesberts 21:b96a3de88002 336 bob.shutdown_pin( PTA3 ); // SWD_DIO
bobgiesberts 21:b96a3de88002 337 // bob.shutdown_pin( PTA20, 1 ); // RESET (does not work properly)
bobgiesberts 21:b96a3de88002 338
bobgiesberts 21:b96a3de88002 339 // Thermometer
bobgiesberts 21:b96a3de88002 340 delete thermometer; thermometer = NULL; // unload library to be able to power down completely
bobgiesberts 21:b96a3de88002 341 bob.shutdown_pin( _Tpin );
bobgiesberts 21:b96a3de88002 342
bobgiesberts 21:b96a3de88002 343 // Button
bobgiesberts 21:b96a3de88002 344 bob.shutdown_pin( _BUTTON );
bobgiesberts 21:b96a3de88002 345
bobgiesberts 12:cceece4f3afb 346
bobgiesberts 16:b53721840a38 347 // if the battery is almost empty (Vbatt < 3.10 V), the thermometer stops
bobgiesberts 12:cceece4f3afb 348 // working well and L can not be corrected. So just shut down...
bobgiesberts 12:cceece4f3afb 349 if( bob.battery() < 3.10f )
bobgiesberts 12:cceece4f3afb 350 {
bobgiesberts 21:b96a3de88002 351 bob.error( 5 ); // error: battery empty
bobgiesberts 12:cceece4f3afb 352 // pc.printf( "Battery empty (%.1f V), shutting down.\n", bob.battery() );
bobgiesberts 12:cceece4f3afb 353 exit(0);
bobgiesberts 12:cceece4f3afb 354 }
bobgiesberts 10:3cab80866536 355
bobgiesberts 11:599ca9982e45 356 // what time is it now?
bobgiesberts 11:599ca9982e45 357 prev = now;
bobgiesberts 11:599ca9982e45 358 now = (uint32_t) clock();
bobgiesberts 11:599ca9982e45 359 if( now < prev )
bobgiesberts 11:599ca9982e45 360 t_high++;
bobgiesberts 11:599ca9982e45 361 t = now + 429496.7296*t_high + t_lost + 429496.7296*lost_high;
bobgiesberts 10:3cab80866536 362
bobgiesberts 8:8cc1960467ae 363 // Calculate sleeping time (correction to INTERVAL_OFF)
bobgiesberts 12:cceece4f3afb 364 // t has passed the limit of next. Those few ms are substracted from INTERVAL_OFF.
bobgiesberts 11:599ca9982e45 365 t_sleep = INTERVAL_OFF*100 - (t - next);
bobgiesberts 8:8cc1960467ae 366
bobgiesberts 12:cceece4f3afb 367 // Calculate time that will be lost during sleep
bobgiesberts 11:599ca9982e45 368 lost_prev = t_lost;
bobgiesberts 11:599ca9982e45 369 t_lost += t_sleep;
bobgiesberts 11:599ca9982e45 370 if( t_lost < lost_prev )
bobgiesberts 11:599ca9982e45 371 lost_high++;
bobgiesberts 13:2caedc56b863 372
bobgiesberts 11:599ca9982e45 373 // Sleep now (ms), enter low power mode
bobgiesberts 11:599ca9982e45 374 bob.sleep( t_sleep * 10 );
bobgiesberts 10:3cab80866536 375
bobgiesberts 0:e81b68888268 376 }
bobgiesberts 21:b96a3de88002 377 }
bobgiesberts 11:599ca9982e45 378
bobgiesberts 11:599ca9982e45 379