Tick Tock / Mbed 2 deprecated default

Dual CANbus monitor and instrumentation cluster

Dependencies:   SPI_TFTx2 TFT_fonts TOUCH_TFTx2 beep mbed

Fork of CANary by Tick Tock

main.cpp@68:10f7d7dbae19, 2013-04-13 (annotated)

Committer:
TickTock
Date:
Sat Apr 13 22:46:31 2013 +0000
Revision:
68:10f7d7dbae19
Parent:
67:2022fce701d0
Parent:
66:b7476ce7a59e
Child:
70:0700b769ac15
merged

Who changed what in which revision?

UserRevisionLine numberNew contents of line
TickTock 13:62e0f7f39ff5 1 // main.cpp
TickTock 13:62e0f7f39ff5 2
TickTock 4:8d7759f4fe7a 3 //To Do:
TickTock 33:a277743ebdeb 4 // * USB device detect
TickTock 33:a277743ebdeb 5 // * Ability to update binary from the thumb-drive (requires file timestamp)
TickTock 33:a277743ebdeb 6 // * Audible friction brake feedback
TickTock 33:a277743ebdeb 7 // * User-configurable watchpoint
TickTock 33:a277743ebdeb 8 // * Better graphical DTE display with historic efficiency information considered and displayed
TickTock 33:a277743ebdeb 9 // * Add 50% charge option
TickTock 33:a277743ebdeb 10 // * Tire Pressure Sensor display
TickTock 13:62e0f7f39ff5 11
TickTock 12:8e42d7ba8468 12 #include "mbed.h"
TickTock 12:8e42d7ba8468 13 #include "CAN.h"
TickTock 12:8e42d7ba8468 14 #include "beep.h"
TickTock 12:8e42d7ba8468 15 #include "MSCFileSystem.h"
TickTock 12:8e42d7ba8468 16 #include "PowerControl.h"
TickTock 12:8e42d7ba8468 17 #include "EthernetPowerControl.h"
TickTock 12:8e42d7ba8468 18 #include "utility.h"
TickTock 12:8e42d7ba8468 19 #include "displayModes.h"
TickTock 23:cd03f9c3395e 20 #include "TOUCH_TFTx2.h"
TickTock 4:8d7759f4fe7a 21
TickTock 13:62e0f7f39ff5 22 LocalFileSystem local("local");
TickTock 13:62e0f7f39ff5 23
TickTock 13:62e0f7f39ff5 24 // to write to USB Flash Drives, or equivalent (SD card in Reader/Writer)
TickTock 35:5acbd8a64a89 25 MSCFileSystem fs("usb"); // to write to a USB Flash Drive
TickTock 13:62e0f7f39ff5 26
TickTock 13:62e0f7f39ff5 27 time_t seconds ;
TickTock 13:62e0f7f39ff5 28
TickTock 36:dbd39c315258 29 Ticker autoPoll;
TickTock 36:dbd39c315258 30 Ticker playback;
TickTock 13:62e0f7f39ff5 31 Timer timer;
TickTock 13:62e0f7f39ff5 32
TickTock 13:62e0f7f39ff5 33 DigitalOut led1(LED1);
TickTock 13:62e0f7f39ff5 34 DigitalOut led2(LED2);
TickTock 13:62e0f7f39ff5 35 DigitalOut led3(LED3);
TickTock 13:62e0f7f39ff5 36 DigitalOut led4(LED4);
TickTock 13:62e0f7f39ff5 37
TickTock 13:62e0f7f39ff5 38 InterruptIn touchpad(p17);
TickTock 13:62e0f7f39ff5 39 CAN can1(p9, p10); // CAN1 (EV) uses pins 9 and 10 (rx, tx) and pin 8 (rs)
TickTock 13:62e0f7f39ff5 40 DigitalOut can1SleepMode(p8); // Use pin 8 to control the sleep mode of can2
TickTock 13:62e0f7f39ff5 41 CAN can2(p30, p29); // CAN2 (CAR) uses pins 30 and 29 (rx, tx) and pin 28 (rs)
TickTock 13:62e0f7f39ff5 42 DigitalOut can2SleepMode(p28); // Use pin 28 to control the sleep mode of can1
TickTock 35:5acbd8a64a89 43 AnalogIn mon12V(p15);
TickTock 13:62e0f7f39ff5 44 TOUCH_TFTx2 tt(p16, p17, p19, p20, p11, p12, p13, p6, p7, p5, "TFT"); // x+,x-,y+,y-,mosi, miso, sclk, cs0, cs1, reset
TickTock 35:5acbd8a64a89 45 PwmOut dled(p23);
TickTock 35:5acbd8a64a89 46 Beep spkr(p21);
TickTock 13:62e0f7f39ff5 47
TickTock 48:d1ce92104a1f 48 bool logEn = false, logOpen = false;
TickTock 48:d1ce92104a1f 49 bool yesBattLog = false ; // gg - Batt Log
garygid 54:6ce808d0995e 50 unsigned char tNavRow = 3 ; // gg - 4x4 touch
garygid 54:6ce808d0995e 51
TickTock 15:a359fecf85ba 52 FILE *cfile;
TickTock 13:62e0f7f39ff5 53 FILE *file;
TickTock 13:62e0f7f39ff5 54 char fileName[35] = "" ;
TickTock 13:62e0f7f39ff5 55 char writeBuffer[maxBufLen][13]; // buffer for USB write
TickTock 13:62e0f7f39ff5 56 char indexLastMsg[0x800]={0}; // index table for last message
TickTock 13:62e0f7f39ff5 57 CANMessage lastMsg[100]; // table to store last message of eachtype
TickTock 13:62e0f7f39ff5 58 unsigned char battData[256]={0};
TickTock 13:62e0f7f39ff5 59 unsigned char msgChanged[100]; // inidcates which bytes changed
TickTock 13:62e0f7f39ff5 60 char c;
TickTock 13:62e0f7f39ff5 61 volatile int writePointer = 0;
TickTock 20:3bf176d14b14 62 volatile int secsNoMsg = 0;
TickTock 20:3bf176d14b14 63 volatile int secsNoTouch = 0;
TickTock 20:3bf176d14b14 64 volatile bool canIdle;
TickTock 20:3bf176d14b14 65 volatile bool userIdle;
TickTock 26:462ccb580472 66 bool touched=false; //flag to read touchscreen
TickTock 42:4533b13b297d 67 unsigned char whichTouched = 0;
TickTock 13:62e0f7f39ff5 68 char counter = 0;
TickTock 41:8d4609ea7259 69 unsigned char dMode[2] = {mainScreen,brakeScreen}; //display mode
TickTock 13:62e0f7f39ff5 70 unsigned char sMode = 0; // setup mode
TickTock 13:62e0f7f39ff5 71 unsigned char lastDMode[2] = {0,0}; //last screen mode
TickTock 25:ddf0ec209f03 72 unsigned char dtMode = 6;
TickTock 13:62e0f7f39ff5 73 char displayLog[20][40];
TickTock 13:62e0f7f39ff5 74 unsigned char displayLoc = 0;
TickTock 13:62e0f7f39ff5 75 unsigned char indexOffset = 1;
TickTock 13:62e0f7f39ff5 76 bool showCP = false;
TickTock 33:a277743ebdeb 77 bool pollCP = false;
TickTock 39:eef8beac7411 78 bool logCP = false; //Turbo3
TickTock 33:a277743ebdeb 79 bool repeatPoll = false;
TickTock 34:4751a8259b18 80 bool headlights = false;
TickTock 34:4751a8259b18 81 bool tick = false;
TickTock 35:5acbd8a64a89 82 float ledHi = 0.8; // Bright LED value (until config file read)
TickTock 35:5acbd8a64a89 83 float ledLo = 0.1; // Dim LED value (until config file read)
TickTock 35:5acbd8a64a89 84 unsigned short pollInt = 300; // polling interval=5 minutes (until config file read)
TickTock 35:5acbd8a64a89 85 bool accOn = false; // Accessories on
TickTock 49:a3d2c5bb3cfa 86 bool laccOn = false;
TickTock 35:5acbd8a64a89 87 float scale12V = 16.2; // R1:R2 ratio
TickTock 40:0e6e71a7323f 88 signed long mWs_x4 = 0;
TickTock 40:0e6e71a7323f 89 unsigned short numWsamples = 0;
TickTock 41:8d4609ea7259 90 unsigned short numSsamples = 0;
TickTock 35:5acbd8a64a89 91 float accV = 0;
TickTock 36:dbd39c315258 92 bool playbackEn = false;
TickTock 36:dbd39c315258 93 bool playbackOpen = false;
TickTock 49:a3d2c5bb3cfa 94 //float playbackInt = 0.05; //read messages every 50 ms
TickTock 49:a3d2c5bb3cfa 95 float playbackInt = 0.005; //read messages every 50 ms
TickTock 36:dbd39c315258 96 bool step = false;
TickTock 37:fea2c1d52c5f 97 char header[5];
TickTock 36:dbd39c315258 98 char data[8];
TickTock 41:8d4609ea7259 99 signed long motorRPM;
garygid 65:821fc79cd7fe 100 unsigned char skin = ttSkin ;
TickTock 50:83d5864c64a0 101 unsigned char dtePeriod = 14; //ten minute averaging interval
TickTock 49:a3d2c5bb3cfa 102 float mph[39]={0};
TickTock 49:a3d2c5bb3cfa 103 float kW[39]={0};
TickTock 49:a3d2c5bb3cfa 104 float mpkWh[39]={0};
TickTock 49:a3d2c5bb3cfa 105 // Logarithmic division scale (roughly - snapped to common units of time)
TickTock 49:a3d2c5bb3cfa 106 float timeConstant[39] = {1, 1.58, 2.51, 3.98, 6.31, 10, 15.8, 25.1, 39.8, 60, // 1 minute
TickTock 52:d5385fbf4ea1 107 60*1.58, 60*2.51, 60*3.98, 60*6.31, 60*10, 60*15.8, 60*25.1, 60*39.8, 60*60, // 1 hour
TickTock 52:d5385fbf4ea1 108 60*60*1.58, 60*60*2.51, 60*60*3.98, 60*60*6.31, 60*60*10, 60*60*15.8, 60*60*24, // 1 day
TickTock 52:d5385fbf4ea1 109 60*60*24*1.58, 60*60*24*2.51, 60*60*24*3.98, 60*60*24*6.31, 60*60*24*10, 60*60*24*15.8, 60*60*24*30, // 1 month
TickTock 52:d5385fbf4ea1 110 60*60*24*39.8, 60*60*24*63.1, 60*60*24*100, 60*60*24*158, 60*60*24*251, 60*60*24*365}; // 1 year
TickTock 49:a3d2c5bb3cfa 111 bool updateDTE = false;
TickTock 13:62e0f7f39ff5 112
TickTock 0:1596b8644523 113 int main() {
TickTock 2:71b1999a8ea5 114 int readPointer=0;
TickTock 4:8d7759f4fe7a 115 char sTemp[40];
TickTock 2:71b1999a8ea5 116 unsigned long secs;
TickTock 49:a3d2c5bb3cfa 117 unsigned char i,j,display=0,lwt=0;
TickTock 22:a43df3905863 118 point lastTouch;
TickTock 52:d5385fbf4ea1 119 float average;
TickTock 7:17bf9ceaf0aa 120
TickTock 8:67eed72f3e10 121 can1.monitor(true); // set to snoop mode
TickTock 8:67eed72f3e10 122 can2.monitor(true); // set to snoop mode
TickTock 2:71b1999a8ea5 123 can1.frequency(500000);
TickTock 2:71b1999a8ea5 124 can2.frequency(500000);
TickTock 7:17bf9ceaf0aa 125 can1SleepMode = 1; // Turn on Monitor_only Mode
TickTock 7:17bf9ceaf0aa 126 can2SleepMode = 1; // Turn on Monitor_only Mode
TickTock 0:1596b8644523 127 can1.attach(&recieve1);
TickTock 0:1596b8644523 128 can2.attach(&recieve2);
TickTock 4:8d7759f4fe7a 129
TickTock 3:3e879b043bc5 130 tt.set_orientation(1);
TickTock 4:8d7759f4fe7a 131 tt.background(Black);
TickTock 19:d576298c46f3 132 tt.set_display(2); // select both displays
TickTock 3:3e879b043bc5 133 tt.cls();
TickTock 1:9dcd70c32180 134 tt.claim(stdout); // send stdout to the TFT display
TickTock 12:8e42d7ba8468 135 touchpad.rise(&touch_ISR);
TickTock 4:8d7759f4fe7a 136 tt.wfi(); // enable interrupt on touch
TickTock 7:17bf9ceaf0aa 137 dled = 0.8; // turn on display LED 80%
TickTock 26:462ccb580472 138
TickTock 2:71b1999a8ea5 139 timer.start() ;
TickTock 2:71b1999a8ea5 140 RTC_Init(); // start the RTC Interrupts that sync the timer
TickTock 1:9dcd70c32180 141 struct tm t; // pointer to a static tm structure
TickTock 19:d576298c46f3 142 NVIC_SetPriority(TIMER3_IRQn, 1); //set ticker priority
TickTock 19:d576298c46f3 143 NVIC_SetPriority(CAN_IRQn, 2); //higher than can (so RTC sync works)
TickTock 33:a277743ebdeb 144
TickTock 1:9dcd70c32180 145 seconds = time(NULL);
TickTock 1:9dcd70c32180 146 t = *localtime(&seconds) ;
TickTock 1:9dcd70c32180 147 // is it a date before 2012 ?
TickTock 26:462ccb580472 148 if ((t.tm_year + 1900) < 2012 ) {
TickTock 26:462ccb580472 149 // before 2013 so update year to make date entry easier
TickTock 26:462ccb580472 150 t.tm_year = 2013 - 1900;
TickTock 1:9dcd70c32180 151 // set the RTC
TickTock 1:9dcd70c32180 152 set_time(mktime(&t));
TickTock 1:9dcd70c32180 153 seconds = time(NULL);
TickTock 26:462ccb580472 154 }
TickTock 20:3bf176d14b14 155 t = *localtime(&seconds) ;
TickTock 20:3bf176d14b14 156 strftime(sTemp, 32, "%a %m/%d/%Y %X\n", &t);
TickTock 20:3bf176d14b14 157 logMsg(sTemp);
garygid 54:6ce808d0995e 158
TickTock 62:ffd15edb5431 159 // revision
TickTock 68:10f7d7dbae19 160 sprintf(sTemp,"CANary firmware rev68\n");
TickTock 43:e7f6f80590e3 161 logMsg(sTemp);
TickTock 15:a359fecf85ba 162
TickTock 26:462ccb580472 163 // Look for new binary on thumbdrive
TickTock 17:e32324a2678d 164 // Can't make this work right now since USB doesn't attach the right timestamp (so new binary isn't loaded)
TickTock 35:5acbd8a64a89 165 /*cfile = fopen("/usb/CANary.bin", "rb");
TickTock 50:83d5864c64a0 166 lastDMode[whichTouched]=99;//force refresh
TickTock 17:e32324a2678d 167 if (cfile!=NULL){ //found a new binary on the thumbdrive so copy it over
TickTock 17:e32324a2678d 168 sprintf(sTemp,"New binary found.\n");
TickTock 17:e32324a2678d 169 logMsg(sTemp);
TickTock 17:e32324a2678d 170 file = fopen("/local/CANary.bin", "wb");
TickTock 17:e32324a2678d 171 if (file==NULL){ //failed to open destination
TickTock 17:e32324a2678d 172 sprintf(sTemp,"Unable to open destination file.\n");
TickTock 17:e32324a2678d 173 logMsg(sTemp);
TickTock 17:e32324a2678d 174 } else {
TickTock 18:999401f359a5 175 tt.set_display(2);
TickTock 18:999401f359a5 176 tt.foreground(White);
TickTock 18:999401f359a5 177 tt.background(Black);
TickTock 18:999401f359a5 178 tt.cls();
TickTock 18:999401f359a5 179 tt.locate(1,40);
TickTock 18:999401f359a5 180 printf("%s\n","Copying binary - Do no remove power.");
TickTock 18:999401f359a5 181 tt.locate(1,80);
TickTock 18:999401f359a5 182 printf("CANary will reset when complete.\n");
TickTock 18:999401f359a5 183 wait(1); //Wait 1 sec for display DMA to finish before writing file
TickTock 17:e32324a2678d 184 while ( int size = fread( writeBuffer, sizeof(char), maxBufLen*13, cfile )){
TickTock 17:e32324a2678d 185 fwrite( writeBuffer, sizeof(char), size, file );
TickTock 18:999401f359a5 186 led4=led3;
TickTock 18:999401f359a5 187 led3=led2;
TickTock 18:999401f359a5 188 led2=led1;
TickTock 18:999401f359a5 189 led1=!led4;
TickTock 17:e32324a2678d 190 }
TickTock 17:e32324a2678d 191 fclose(cfile);
TickTock 17:e32324a2678d 192 fclose(file);
TickTock 35:5acbd8a64a89 193 remove("/usb/CANary.bin"); // delete original
TickTock 17:e32324a2678d 194 mbed_reset(); //restart
TickTock 17:e32324a2678d 195 }
TickTock 18:999401f359a5 196 }*/
TickTock 17:e32324a2678d 197
TickTock 26:462ccb580472 198 secsNoMsg = 0;
TickTock 43:e7f6f80590e3 199
TickTock 49:a3d2c5bb3cfa 200 //read efficiency history data
TickTock 49:a3d2c5bb3cfa 201 cfile = fopen("/local/ehist.cny", "r");
TickTock 49:a3d2c5bb3cfa 202 if (cfile!=NULL){ // found a efficiency history file
TickTock 49:a3d2c5bb3cfa 203 for(i=0;i<39;i++){
TickTock 49:a3d2c5bb3cfa 204 if(!feof(cfile)){
TickTock 49:a3d2c5bb3cfa 205 fscanf(cfile,"%f %f\r\n",&mph[i],&kW[i]);
TickTock 49:a3d2c5bb3cfa 206 mpkWh[i]=mph[i]/kW[i];
TickTock 49:a3d2c5bb3cfa 207 }
TickTock 49:a3d2c5bb3cfa 208 }
TickTock 49:a3d2c5bb3cfa 209 fclose(cfile);
TickTock 49:a3d2c5bb3cfa 210 sprintf(sTemp,"History Loaded.\n");
TickTock 49:a3d2c5bb3cfa 211 logMsg(sTemp);
TickTock 49:a3d2c5bb3cfa 212 } else { // create initial file
TickTock 49:a3d2c5bb3cfa 213 sprintf(sTemp,"History not found. Created.\n");
TickTock 49:a3d2c5bb3cfa 214 logMsg(sTemp);
TickTock 49:a3d2c5bb3cfa 215 for(i=0;i<39;i++){
TickTock 49:a3d2c5bb3cfa 216 // Pre-load with 4 mpkWh @ 40 mph
TickTock 49:a3d2c5bb3cfa 217 mph[i]=40*timeConstant[i];
TickTock 49:a3d2c5bb3cfa 218 kW[i]=10*timeConstant[i];
TickTock 49:a3d2c5bb3cfa 219 mpkWh[i]=4;
TickTock 49:a3d2c5bb3cfa 220 }
TickTock 49:a3d2c5bb3cfa 221 }
TickTock 49:a3d2c5bb3cfa 222
TickTock 46:73e8716f976f 223 // Read config file
TickTock 46:73e8716f976f 224 readConfig();
TickTock 43:e7f6f80590e3 225
TickTock 26:462ccb580472 226 touched=false;
TickTock 26:462ccb580472 227 secsNoTouch=2;
TickTock 2:71b1999a8ea5 228 while (true) {
TickTock 4:8d7759f4fe7a 229 if (!logOpen) { // Open new file if one is not already open
TickTock 7:17bf9ceaf0aa 230 if(logEn){ //logging enable
TickTock 7:17bf9ceaf0aa 231 seconds = time(NULL);
TickTock 7:17bf9ceaf0aa 232 t = *localtime(&seconds) ;
TickTock 35:5acbd8a64a89 233 strftime(fileName, 32, "/usb/%m%d%H%M.alc", &t); //mmddhhmm.alc
TickTock 16:2a6ca248e1cb 234 //sprintf(sTemp,"Using file %s\n",fileName);
TickTock 16:2a6ca248e1cb 235 //logMsg(sTemp);
TickTock 7:17bf9ceaf0aa 236 file = fopen(fileName, "ab");
TickTock 50:83d5864c64a0 237 lastDMode[whichTouched]=99;//force refresh
TickTock 7:17bf9ceaf0aa 238 if(file==NULL){
TickTock 7:17bf9ceaf0aa 239 sprintf(sTemp,"\nUnable to open %s\n\n\n\n",fileName);
TickTock 7:17bf9ceaf0aa 240 logMsg(sTemp);
TickTock 7:17bf9ceaf0aa 241 logEn=false;
TickTock 26:462ccb580472 242 spkr.beep(1000,0.25);
TickTock 7:17bf9ceaf0aa 243 } else {
TickTock 7:17bf9ceaf0aa 244 logOpen = true;
TickTock 7:17bf9ceaf0aa 245 readPointer=writePointer;
TickTock 7:17bf9ceaf0aa 246 sprintf(sTemp,"Starting Can Log %s\n",fileName);
TickTock 7:17bf9ceaf0aa 247 logMsg(sTemp);
TickTock 7:17bf9ceaf0aa 248 logTS();
TickTock 26:462ccb580472 249 spkr.beep(2000,0.25);
TickTock 7:17bf9ceaf0aa 250 }
TickTock 7:17bf9ceaf0aa 251 }//logging enabled
TickTock 15:a359fecf85ba 252 } else { // if (logOpen)
TickTock 30:e633a63eb257 253 if (((writePointer+maxBufLen-readPointer)%maxBufLen)>(maxBufLen/16)||canIdle||!logEn) {
TickTock 7:17bf9ceaf0aa 254 // Dump buffer if > 1/16 full or canbus has stopped
TickTock 7:17bf9ceaf0aa 255 if (file == NULL) {
TickTock 7:17bf9ceaf0aa 256 logOpen = false;
TickTock 37:fea2c1d52c5f 257 sprintf(sTemp,"Failed to append log file.\n");
TickTock 37:fea2c1d52c5f 258 logMsg(sTemp);
TickTock 26:462ccb580472 259 spkr.beep(1000,0.25);
TickTock 7:17bf9ceaf0aa 260 logEn=false;
TickTock 7:17bf9ceaf0aa 261 } else {
TickTock 37:fea2c1d52c5f 262 if (((writePointer+maxBufLen-readPointer)%maxBufLen)>(maxBufLen*7/8)) { // Hi-water mark
TickTock 37:fea2c1d52c5f 263 sprintf(sTemp,"Write buffer overrun.\n");
TickTock 37:fea2c1d52c5f 264 logMsg(sTemp);
TickTock 37:fea2c1d52c5f 265 spkr.beep(1000,0.25);
TickTock 37:fea2c1d52c5f 266 }
TickTock 7:17bf9ceaf0aa 267 while (readPointer != writePointer) {
TickTock 7:17bf9ceaf0aa 268 for (j = 0; j<13; j++){
TickTock 7:17bf9ceaf0aa 269 fprintf(file,"%c",writeBuffer[readPointer][j]);
TickTock 4:8d7759f4fe7a 270 }
TickTock 7:17bf9ceaf0aa 271 if(++readPointer >= maxBufLen)
TickTock 7:17bf9ceaf0aa 272 readPointer=0;
TickTock 4:8d7759f4fe7a 273 }
TickTock 7:17bf9ceaf0aa 274 led4 = !led4;
TickTock 7:17bf9ceaf0aa 275 }
TickTock 30:e633a63eb257 276 } // if > 1/16 full, canbus has stopped, or logging stopped
TickTock 30:e633a63eb257 277 if (!logEn) {
TickTock 30:e633a63eb257 278 fclose(file);
TickTock 30:e633a63eb257 279 logOpen=false;
TickTock 30:e633a63eb257 280 }
TickTock 4:8d7759f4fe7a 281 } // if logOpen
TickTock 36:dbd39c315258 282 if (canIdle&&userIdle&&!playbackEn) { // canbus idle --> sleep to save power
TickTock 26:462ccb580472 283 if (logOpen){
TickTock 7:17bf9ceaf0aa 284 fclose(file);
TickTock 7:17bf9ceaf0aa 285 } // if (logOpen)*/
TickTock 20:3bf176d14b14 286 seconds = time(NULL);
TickTock 20:3bf176d14b14 287 t = *localtime(&seconds) ;
TickTock 21:22bdce9efcb5 288 strftime(sTemp, 40, "Sleeping: %a %m/%d/%Y %X\n", &t);
TickTock 4:8d7759f4fe7a 289 logMsg(sTemp);
TickTock 25:ddf0ec209f03 290 updateDisplay(0); //Added for turbo3 who has a display override and wants to see the sleep message before going to sleep
TickTock 25:ddf0ec209f03 291 updateDisplay(1);
TickTock 4:8d7759f4fe7a 292 //LPC_RTC->CIIR=0x00; // block RTC interrupts
TickTock 4:8d7759f4fe7a 293 led1=0;
TickTock 4:8d7759f4fe7a 294 led2=0;
TickTock 4:8d7759f4fe7a 295 led3=0;
TickTock 4:8d7759f4fe7a 296 led4=0;
TickTock 4:8d7759f4fe7a 297 dled=0; // turn off display
TickTock 4:8d7759f4fe7a 298 secs = time(NULL); // seconds past 12:00:00 AM 1 Jan 1900
TickTock 22:a43df3905863 299 while (secsNoMsg>canTimeout && !touched) {
TickTock 4:8d7759f4fe7a 300 //DeepPowerDown();
TickTock 12:8e42d7ba8468 301 tt.wfi(); //enable touch interrupt
TickTock 21:22bdce9efcb5 302 //__wfi(); // freeze CPU and wait for interrupt (from canbus or touch)
TickTock 21:22bdce9efcb5 303 Sleep();
TickTock 4:8d7759f4fe7a 304 }
TickTock 43:e7f6f80590e3 305 secsNoTouch=2;
TickTock 4:8d7759f4fe7a 306 canIdle=secsNoMsg>canTimeout;
TickTock 43:e7f6f80590e3 307 //userIdle=!touched;
TickTock 7:17bf9ceaf0aa 308 dled=0.8; // turn on display LED
TickTock 20:3bf176d14b14 309 seconds = time(NULL);
TickTock 20:3bf176d14b14 310 t = *localtime(&seconds) ;
TickTock 21:22bdce9efcb5 311 strftime(sTemp, 40, "Waking: %a %m/%d/%Y %X\n", &t);
TickTock 4:8d7759f4fe7a 312 logMsg(sTemp);
TickTock 4:8d7759f4fe7a 313 if (time(NULL)>(secs+1800)) {
TickTock 4:8d7759f4fe7a 314 logOpen = false; // Start new file if asleep for more than 30 minutes
TickTock 4:8d7759f4fe7a 315 if (secsNoTouch>100) secsNoTouch = 100; // also mostly reset user Idle counter
TickTock 43:e7f6f80590e3 316 } else if (logOpen){ // insert timestamp on each wake if logging enabled (disabled for now)
TickTock 7:17bf9ceaf0aa 317 file = fopen(fileName, "ab");
TickTock 4:8d7759f4fe7a 318 logTS();
TickTock 4:8d7759f4fe7a 319 }
TickTock 4:8d7759f4fe7a 320 } // if idle
TickTock 4:8d7759f4fe7a 321
TickTock 15:a359fecf85ba 322 if(touched){ // call touchscreen procedure if touch interrupt detected
TickTock 7:17bf9ceaf0aa 323 lastTouch = tt.get_touch();
TickTock 7:17bf9ceaf0aa 324 lastTouch = tt.to_pixel(lastTouch); // convert to pixel pos
TickTock 40:0e6e71a7323f 325 if((lastTouch.x!=639)&&(lastTouch.x!=319)&&(lastTouch.y!=239)){ // filter phantom touches
TickTock 43:e7f6f80590e3 326 if (userIdle) {
TickTock 43:e7f6f80590e3 327 secsNoTouch=2; // Ignore first touch if user idle
TickTock 43:e7f6f80590e3 328 userIdle=false;
TickTock 40:0e6e71a7323f 329 } else {
TickTock 43:e7f6f80590e3 330 secsNoTouch=0;
TickTock 40:0e6e71a7323f 331 }
TickTock 43:e7f6f80590e3 332 if (lastTouch.x>320){
TickTock 43:e7f6f80590e3 333 whichTouched=1;
TickTock 43:e7f6f80590e3 334 } else {
TickTock 43:e7f6f80590e3 335 whichTouched=0;
TickTock 43:e7f6f80590e3 336 }
TickTock 43:e7f6f80590e3 337 if (whichTouched!=lwt){
TickTock 43:e7f6f80590e3 338 lastDMode[lwt]=99; // Repaint lastTouched
TickTock 43:e7f6f80590e3 339 lwt=whichTouched;
TickTock 43:e7f6f80590e3 340 }
TickTock 43:e7f6f80590e3 341 sMode = 1;
TickTock 22:a43df3905863 342 }
TickTock 22:a43df3905863 343 //sprintf(sTemp,"%d,%d ",lastTouch.x,lastTouch.y);
TickTock 22:a43df3905863 344 //logMsg(sTemp);
TickTock 12:8e42d7ba8468 345 touched = false; // clear interrupt flag
TickTock 7:17bf9ceaf0aa 346 }
garygid 54:6ce808d0995e 347 //---------------
garygid 54:6ce808d0995e 348 // gg - 4x4 touch
TickTock 62:ffd15edb5431 349 //unsigned char tScrn = 0 ; // screen 0
garygid 54:6ce808d0995e 350 unsigned char tCol ;
garygid 54:6ce808d0995e 351 unsigned char tRow ;
garygid 54:6ce808d0995e 352
TickTock 4:8d7759f4fe7a 353 if (!userIdle) {
TickTock 4:8d7759f4fe7a 354 if (secsNoTouch<2) {// Recently touched
TickTock 4:8d7759f4fe7a 355 secsNoTouch +=2; // increment to prevent double touch
TickTock 43:e7f6f80590e3 356 sMode = 1;
TickTock 22:a43df3905863 357 //sprintf(sTemp,"button %d %d,%d %d\n",i,buttonX(lastTouch.x,3),buttonY(lastTouch.y,3),lastTouch.x);
TickTock 22:a43df3905863 358 //logMsg(sTemp);
TickTock 23:cd03f9c3395e 359 switch (sMode) {
TickTock 23:cd03f9c3395e 360 case 0: // no select
TickTock 23:cd03f9c3395e 361 break;
TickTock 63:aa3bf6a33635 362 case 1: // select screen
garygid 54:6ce808d0995e 363 //--------------
garygid 54:6ce808d0995e 364 // gg - 4x4 touch
garygid 54:6ce808d0995e 365 tCol = buttonX(lastTouch.x,4) ;
TickTock 62:ffd15edb5431 366 if( tCol >= 4 ){ tCol -= 4; } // touch is on screen 1
garygid 54:6ce808d0995e 367
garygid 54:6ce808d0995e 368 tRow = buttonY(lastTouch.y,4) ;
garygid 54:6ce808d0995e 369
TickTock 63:aa3bf6a33635 370 highlightButton( tCol,tRow, whichTouched, 4,4) ; // gg - highlight
garygid 58:4d06288d75a2 371
TickTock 63:aa3bf6a33635 372 if( tRow == tNavRow ) tRow = 7 ; // gg
garygid 54:6ce808d0995e 373 switch ( (tCol*10) + tRow ) {
garygid 54:6ce808d0995e 374 //---------------------------------
garygid 67:2022fce701d0 375 case 00: // top row, left button on screen 0 or 1
TickTock 42:4533b13b297d 376 if (dMode[whichTouched]==monitorScreen||dMode[whichTouched]==changedScreen) {
garygid 67:2022fce701d0 377 indexOffset=indexOffset>4?indexOffset-4:1;
garygid 67:2022fce701d0 378 } else if (dMode[whichTouched] == indexScreen) { // gg - index
garygid 67:2022fce701d0 379 dMode[whichTouched] = mainScreen ; // GoTo Main Screen
TickTock 42:4533b13b297d 380 } else if (dMode[whichTouched]==config1Screen) {
TickTock 23:cd03f9c3395e 381 wait_ms(500);
TickTock 37:fea2c1d52c5f 382 tt.background(Black);
TickTock 23:cd03f9c3395e 383 tt.calibrate();
TickTock 42:4533b13b297d 384 } else if (dMode[whichTouched]==playbackScreen) { // slower
TickTock 36:dbd39c315258 385 playbackInt *=2;
TickTock 36:dbd39c315258 386 if(playbackEn){
TickTock 36:dbd39c315258 387 playback.detach();
TickTock 36:dbd39c315258 388 playback.attach(&playbackISR,playbackInt);
TickTock 36:dbd39c315258 389 }
TickTock 62:ffd15edb5431 390 } else {
TickTock 62:ffd15edb5431 391 lastDMode[whichTouched]=99;//repaint to clear highlight
TickTock 23:cd03f9c3395e 392 }
TickTock 23:cd03f9c3395e 393 break;
garygid 54:6ce808d0995e 394 //-----------------------------------------------
garygid 67:2022fce701d0 395 case 10: // 1,0 (col left of center,top row) on screen 0 or 1
TickTock 42:4533b13b297d 396 if (dMode[whichTouched]==changedScreen) {
TickTock 23:cd03f9c3395e 397 for(j=0;j<100;j++) msgChanged[j]=0; // clear changed data
TickTock 42:4533b13b297d 398 lastDMode[whichTouched]=99;//force refresh
garygid 67:2022fce701d0 399 } else if (dMode[whichTouched] == indexScreen) { // gg - index
garygid 67:2022fce701d0 400 dMode[whichTouched] = brakeScreen ; // GoTo Brake Screen
TickTock 42:4533b13b297d 401 } else if (dMode[whichTouched]==cpScreen) {
TickTock 33:a277743ebdeb 402 pollCP=true;
TickTock 48:d1ce92104a1f 403 } else if (dMode[whichTouched]==cpHistScreen) { // gg - hist
TickTock 48:d1ce92104a1f 404 pollCP=true;
TickTock 48:d1ce92104a1f 405 } else if (dMode[whichTouched]==cpBarScreen) { // gg - cpbars
TickTock 46:73e8716f976f 406 pollCP=true;
TickTock 42:4533b13b297d 407 } else if (dMode[whichTouched]==config1Screen) {
TickTock 23:cd03f9c3395e 408 mbed_reset();
TickTock 42:4533b13b297d 409 } else if (dMode[whichTouched]==playbackScreen) { // pause/unpause
TickTock 36:dbd39c315258 410 playbackEn=!playbackEn;
TickTock 36:dbd39c315258 411 if(playbackEn){
TickTock 36:dbd39c315258 412 playback.attach(&playbackISR,playbackInt);
TickTock 62:ffd15edb5431 413 } else {
TickTock 36:dbd39c315258 414 playback.detach();
TickTock 36:dbd39c315258 415 }
TickTock 62:ffd15edb5431 416 } else {
TickTock 62:ffd15edb5431 417 lastDMode[whichTouched]=99;//repaint to clear highlight
TickTock 23:cd03f9c3395e 418 }
TickTock 62:ffd15edb5431 419
TickTock 23:cd03f9c3395e 420 break;
garygid 54:6ce808d0995e 421 //--------------------------------------
garygid 54:6ce808d0995e 422 case 20: // col 2 and row 0 on either screen 0 or 1
TickTock 42:4533b13b297d 423 if (dMode[whichTouched]==monitorScreen||dMode[whichTouched]==changedScreen) {
TickTock 23:cd03f9c3395e 424 indexOffset=indexOffset<77?indexOffset+4:80;
garygid 67:2022fce701d0 425 } else if (dMode[whichTouched] == indexScreen) { // gg - index
garygid 67:2022fce701d0 426 dMode[whichTouched] = effScreen ; // GoTo EFF Screen
TickTock 42:4533b13b297d 427 } else if (dMode[whichTouched]==config1Screen) {
TickTock 23:cd03f9c3395e 428 sprintf(sTemp,"Saving config file.\n");
TickTock 23:cd03f9c3395e 429 logMsg(sTemp);
TickTock 25:ddf0ec209f03 430 saveConfig();
TickTock 26:462ccb580472 431 spkr.beep(2000,0.25);
TickTock 42:4533b13b297d 432 } else if (dMode[whichTouched]==playbackScreen) { // faster
TickTock 36:dbd39c315258 433 if(playbackInt>.002){
TickTock 36:dbd39c315258 434 playbackInt/=2;
TickTock 36:dbd39c315258 435 if(playbackEn){
TickTock 36:dbd39c315258 436 playback.detach();
TickTock 36:dbd39c315258 437 playback.attach(&playbackISR,playbackInt);
TickTock 36:dbd39c315258 438 }
TickTock 36:dbd39c315258 439 }
TickTock 62:ffd15edb5431 440 }else{
TickTock 62:ffd15edb5431 441 lastDMode[whichTouched]=99;//repaint to clear highlight
TickTock 23:cd03f9c3395e 442 }
TickTock 62:ffd15edb5431 443
TickTock 23:cd03f9c3395e 444 break;
garygid 65:821fc79cd7fe 445
garygid 67:2022fce701d0 446 case 30: // right-most on top row
garygid 65:821fc79cd7fe 447
garygid 65:821fc79cd7fe 448 if (dMode[whichTouched]==config1Screen) {
garygid 65:821fc79cd7fe 449 // step through skins
garygid 65:821fc79cd7fe 450 if( skin < maxSkin ) skin += 1 ;
garygid 65:821fc79cd7fe 451 else skin = 0 ;
garygid 65:821fc79cd7fe 452
garygid 65:821fc79cd7fe 453 // repaint both screens, I think
garygid 65:821fc79cd7fe 454 lastDMode[whichTouched]=99;//repaint to clear highlight
garygid 65:821fc79cd7fe 455 // and re-paint the other screen too, to see new skin there
garygid 65:821fc79cd7fe 456 lastDMode[whichTouched ^ 1]=99; // repaint other screen (^ = XOR)
garygid 65:821fc79cd7fe 457
garygid 65:821fc79cd7fe 458 //sprintf(sTemp,"Changed Skin to %d.\n");
garygid 65:821fc79cd7fe 459 //logMsg(sTemp);
garygid 65:821fc79cd7fe 460 //saveConfig();
garygid 65:821fc79cd7fe 461 //spkr.beep(2000,0.25);
garygid 67:2022fce701d0 462 } else if (dMode[whichTouched] == indexScreen) { // gg - index
garygid 67:2022fce701d0 463 dMode[whichTouched] = dteScreen ; // GoTo DTE Screen
garygid 65:821fc79cd7fe 464 }else{
garygid 65:821fc79cd7fe 465 lastDMode[whichTouched]=99;//repaint to clear highlight
garygid 65:821fc79cd7fe 466 }
garygid 65:821fc79cd7fe 467
garygid 65:821fc79cd7fe 468 break;
garygid 54:6ce808d0995e 469 //----------------------------------
garygid 54:6ce808d0995e 470 //----------------------------------
garygid 67:2022fce701d0 471 case 01: // left col middle row
TickTock 42:4533b13b297d 472 if (dMode[whichTouched]==config1Screen) {
TickTock 23:cd03f9c3395e 473 logEn = !logEn;
TickTock 40:0e6e71a7323f 474 if (!logEn) repeatPoll=false; // disable auto polling, too
garygid 67:2022fce701d0 475 } else if (dMode[whichTouched] == indexScreen) { // gg - index
garygid 67:2022fce701d0 476 dMode[whichTouched] = cpScreen ; // GoTo CP Data Screen
garygid 67:2022fce701d0 477
TickTock 42:4533b13b297d 478 } else if (dMode[whichTouched]==dateScreen){
TickTock 25:ddf0ec209f03 479 dtMode=(dtMode<6)?dtMode+1:0;
TickTock 42:4533b13b297d 480 lastDMode[whichTouched]=99;
TickTock 62:ffd15edb5431 481 } else {
TickTock 62:ffd15edb5431 482 lastDMode[whichTouched]=99;//repaint to clear highlight
TickTock 23:cd03f9c3395e 483 }
TickTock 62:ffd15edb5431 484
TickTock 23:cd03f9c3395e 485 break;
garygid 54:6ce808d0995e 486 //------------------------------
TickTock 23:cd03f9c3395e 487 case 11:
TickTock 42:4533b13b297d 488 if (dMode[whichTouched]==config1Screen){
TickTock 33:a277743ebdeb 489 repeatPoll = !repeatPoll&&logEn;
TickTock 33:a277743ebdeb 490 if (repeatPoll) {
TickTock 36:dbd39c315258 491 autoPoll.attach(&autoPollISR,pollInt);
TickTock 33:a277743ebdeb 492 } else {
TickTock 36:dbd39c315258 493 autoPoll.detach();
TickTock 33:a277743ebdeb 494 }
garygid 67:2022fce701d0 495 } else if (dMode[whichTouched] == indexScreen) { // gg - index
garygid 67:2022fce701d0 496 dMode[whichTouched] = cpHistScreen ; // GoTo CP Hist Screen
garygid 67:2022fce701d0 497
TickTock 42:4533b13b297d 498 } else if (dMode[whichTouched]==playbackScreen) {
TickTock 36:dbd39c315258 499 // Start/stop playback
TickTock 36:dbd39c315258 500 if(!playbackOpen){
TickTock 36:dbd39c315258 501 if(!logOpen){
TickTock 36:dbd39c315258 502 file = fopen("/usb/playback.alc", "rb");
TickTock 50:83d5864c64a0 503 lastDMode[whichTouched]=99;//force refresh
TickTock 36:dbd39c315258 504 if(file==NULL){
TickTock 36:dbd39c315258 505 sprintf(sTemp,"Unable to open /usb/playback.alc\n");
TickTock 36:dbd39c315258 506 logMsg(sTemp);
TickTock 36:dbd39c315258 507 spkr.beep(1000,0.25);
TickTock 36:dbd39c315258 508 } else {
TickTock 36:dbd39c315258 509 playbackOpen = true;
TickTock 50:83d5864c64a0 510 playbackEn=true;
TickTock 50:83d5864c64a0 511 playback.attach(&playbackISR,playbackInt);
TickTock 36:dbd39c315258 512 sprintf(sTemp,"Starting playback\n");
TickTock 36:dbd39c315258 513 logMsg(sTemp);
TickTock 36:dbd39c315258 514 spkr.beep(2000,0.25);
TickTock 36:dbd39c315258 515 can1.attach(&doNothing);// Stop recieving CAN data
TickTock 36:dbd39c315258 516 can2.attach(&doNothing);
TickTock 36:dbd39c315258 517 }
TickTock 36:dbd39c315258 518 } else {
TickTock 36:dbd39c315258 519 sprintf(sTemp,"Must stop logging first\n");
TickTock 36:dbd39c315258 520 logMsg(sTemp);
TickTock 36:dbd39c315258 521 }
TickTock 36:dbd39c315258 522 } else {
TickTock 36:dbd39c315258 523 playback.detach();
TickTock 36:dbd39c315258 524 fclose(file);
TickTock 36:dbd39c315258 525 playbackOpen=false;
TickTock 50:83d5864c64a0 526 playbackEn=false;
TickTock 36:dbd39c315258 527 can1.attach(&recieve1);// Restore CAN data recieve
TickTock 36:dbd39c315258 528 can2.attach(&recieve2);
TickTock 42:4533b13b297d 529 lastDMode[whichTouched]=99;
TickTock 36:dbd39c315258 530 }
TickTock 42:4533b13b297d 531 } else if (dMode[whichTouched]==dateScreen){
TickTock 25:ddf0ec209f03 532 upDate(dtMode,true);
TickTock 42:4533b13b297d 533 lastDMode[whichTouched]=99;
TickTock 62:ffd15edb5431 534 } else {
TickTock 62:ffd15edb5431 535 lastDMode[whichTouched]=99;//repaint to clear highlight
TickTock 25:ddf0ec209f03 536 }
TickTock 62:ffd15edb5431 537
TickTock 23:cd03f9c3395e 538 break;
garygid 54:6ce808d0995e 539 //---------------------------------
garygid 54:6ce808d0995e 540 case 21: // col 2 row 1
TickTock 48:d1ce92104a1f 541 if (dMode[whichTouched]==config1Screen) { // gg - Batt Log Enable Button
TickTock 48:d1ce92104a1f 542 yesBattLog = !yesBattLog;
garygid 67:2022fce701d0 543 } else if (dMode[whichTouched] == indexScreen) { // gg - index
garygid 67:2022fce701d0 544 dMode[whichTouched] = cpBarScreen ; // GoTo CP Bars Screen
TickTock 48:d1ce92104a1f 545 } else if (dMode[whichTouched]==dateScreen){
TickTock 25:ddf0ec209f03 546 upDate(dtMode,false);
TickTock 42:4533b13b297d 547 lastDMode[whichTouched]=99;
TickTock 62:ffd15edb5431 548 } else {
TickTock 62:ffd15edb5431 549 lastDMode[whichTouched]=99;//repaint to clear highlight
TickTock 25:ddf0ec209f03 550 }
TickTock 62:ffd15edb5431 551
TickTock 23:cd03f9c3395e 552 break;
garygid 54:6ce808d0995e 553
garygid 54:6ce808d0995e 554 //-----------------------------------
garygid 67:2022fce701d0 555 case 02: // left col, bottom row (not nav)
garygid 67:2022fce701d0 556 if (dMode[whichTouched] == indexScreen) { // gg - index
garygid 67:2022fce701d0 557 dMode[whichTouched] = config1Screen ; // GoTo Config Screen
garygid 67:2022fce701d0 558 }
garygid 67:2022fce701d0 559 break;
garygid 67:2022fce701d0 560
garygid 67:2022fce701d0 561 case 12: // left-middle col, bottom row (not nav)
garygid 67:2022fce701d0 562 if (dMode[whichTouched] == indexScreen) { // gg - index
garygid 67:2022fce701d0 563 dMode[whichTouched] = playbackScreen ; // GoTo Playback Screen
garygid 67:2022fce701d0 564 }
garygid 67:2022fce701d0 565 break;
garygid 67:2022fce701d0 566
garygid 67:2022fce701d0 567 case 22: // right-middle col, bottom row (not nav)
garygid 67:2022fce701d0 568 if (dMode[whichTouched] == indexScreen) { // gg - index
garygid 67:2022fce701d0 569 dMode[whichTouched] = dateScreen ; // GoTo Set Date/Time Screen
garygid 67:2022fce701d0 570 }
garygid 67:2022fce701d0 571 break;
garygid 67:2022fce701d0 572
garygid 67:2022fce701d0 573 //-----------------------------------
garygid 54:6ce808d0995e 574 //-----------------------------------
garygid 54:6ce808d0995e 575 // Prev Navigation
garygid 54:6ce808d0995e 576 case 07: // col 0 row tNavRow
TickTock 42:4533b13b297d 577 dMode[whichTouched]=dMode[whichTouched]>0?dMode[whichTouched]-1:maxScreens;
TickTock 22:a43df3905863 578 break;
garygid 54:6ce808d0995e 579 //-----------------------------------
garygid 54:6ce808d0995e 580 // Select Screen Navigation
garygid 54:6ce808d0995e 581 case 17:
TickTock 43:e7f6f80590e3 582 //secsNoTouch = userTimeout; // immediately exit config mode
TickTock 43:e7f6f80590e3 583 sMode=0;
TickTock 43:e7f6f80590e3 584 lastDMode[whichTouched]=99; // Repaint
TickTock 22:a43df3905863 585 break;
garygid 54:6ce808d0995e 586 //-----------------------------------
garygid 54:6ce808d0995e 587 // Index Navigation
garygid 54:6ce808d0995e 588 case 27: // col 2 row tNavRow
garygid 67:2022fce701d0 589 dMode[whichTouched]= indexScreen ; // gg - index
garygid 54:6ce808d0995e 590 break;
garygid 54:6ce808d0995e 591 //------------------------------------
garygid 54:6ce808d0995e 592 // Next Navigation
garygid 54:6ce808d0995e 593 case 37: // lower right on Nav Line gg - move next
TickTock 42:4533b13b297d 594 dMode[whichTouched]=dMode[whichTouched]<maxScreens?dMode[whichTouched]+1:0;
TickTock 22:a43df3905863 595 break;
garygid 54:6ce808d0995e 596 //------------------------------------
garygid 54:6ce808d0995e 597 //------------------------------------
TickTock 22:a43df3905863 598 default:
TickTock 62:ffd15edb5431 599 lastDMode[whichTouched]=99;//repaint to clear highlight
TickTock 25:ddf0ec209f03 600 break;
TickTock 25:ddf0ec209f03 601 }
TickTock 23:cd03f9c3395e 602 break;
TickTock 23:cd03f9c3395e 603 case 2: // numpad
TickTock 23:cd03f9c3395e 604 break;
TickTock 23:cd03f9c3395e 605 case 3:
TickTock 23:cd03f9c3395e 606 break;
TickTock 23:cd03f9c3395e 607 default:
TickTock 23:cd03f9c3395e 608 break;
TickTock 23:cd03f9c3395e 609 } // case sMode
TickTock 22:a43df3905863 610 } //recently touched
TickTock 4:8d7759f4fe7a 611 } else { // userIdle
TickTock 8:67eed72f3e10 612 if(sMode==1){
TickTock 8:67eed72f3e10 613 sMode=0;
TickTock 43:e7f6f80590e3 614 lastDMode[whichTouched]=99;
TickTock 8:67eed72f3e10 615 }
TickTock 4:8d7759f4fe7a 616 }
TickTock 34:4751a8259b18 617
TickTock 34:4751a8259b18 618 if(tick){ // Executes once a second
TickTock 41:8d4609ea7259 619 accV=floor(mon12V*scale12V*10+0.5)/10; //Round to nearest 10th
TickTock 35:5acbd8a64a89 620 accOn=(accV>5)?true:false;
TickTock 49:a3d2c5bb3cfa 621 if(laccOn&&!accOn){ // Car turned off
TickTock 49:a3d2c5bb3cfa 622 //write efficiency history data
TickTock 49:a3d2c5bb3cfa 623 cfile = fopen("/local/ehist.cny", "w");
TickTock 49:a3d2c5bb3cfa 624 if (cfile!=NULL){ // found a efficiency history file
TickTock 49:a3d2c5bb3cfa 625 for(i=0;i<39;i++){
TickTock 49:a3d2c5bb3cfa 626 fprintf(cfile,"%f %f\r\n",mph[i],kW[i]);
TickTock 49:a3d2c5bb3cfa 627 }
TickTock 49:a3d2c5bb3cfa 628 fclose(cfile);
TickTock 49:a3d2c5bb3cfa 629 }
TickTock 49:a3d2c5bb3cfa 630 }
TickTock 49:a3d2c5bb3cfa 631 laccOn=accOn;
TickTock 36:dbd39c315258 632 if(!accOn&&!logEn&&userIdle&&!playbackEn){
TickTock 40:0e6e71a7323f 633 //sprintf(sTemp,"Display Off %4.2f\n",accV);
TickTock 40:0e6e71a7323f 634 //logMsg(sTemp);
TickTock 35:5acbd8a64a89 635 dled = 0; // turn off display if car off and logging disabled and no user activity
TickTock 35:5acbd8a64a89 636 }else if(!headlights){
TickTock 35:5acbd8a64a89 637 dled = ledHi;
TickTock 34:4751a8259b18 638 }else{
TickTock 35:5acbd8a64a89 639 dled = ledLo;
TickTock 34:4751a8259b18 640 }
TickTock 49:a3d2c5bb3cfa 641
TickTock 49:a3d2c5bb3cfa 642 //compute historic efficiency
TickTock 41:8d4609ea7259 643 if(numSsamples>0){ // Avoid div0
TickTock 49:a3d2c5bb3cfa 644 mph[0]=((float) motorRPM)/numSsamples/215; // Empirically derived - may change car to car
TickTock 36:dbd39c315258 645 }else{
TickTock 49:a3d2c5bb3cfa 646 mph[0]=0;
TickTock 36:dbd39c315258 647 }
TickTock 49:a3d2c5bb3cfa 648 if(mph[0]>99){
TickTock 49:a3d2c5bb3cfa 649 mph[0]=0;
TickTock 49:a3d2c5bb3cfa 650 }
TickTock 49:a3d2c5bb3cfa 651 mpkWh[0]=mph[0];
TickTock 41:8d4609ea7259 652 if(numWsamples>0){ // Avoid div0
TickTock 49:a3d2c5bb3cfa 653 kW[0]=((float) mWs_x4)/numWsamples/4e3;
TickTock 49:a3d2c5bb3cfa 654 mpkWh[0]/=kW[0];
TickTock 49:a3d2c5bb3cfa 655 if (mpkWh[0]<0) {
TickTock 49:a3d2c5bb3cfa 656 mpkWh[0]=99;// negative means inf.
TickTock 49:a3d2c5bb3cfa 657 }
TickTock 41:8d4609ea7259 658 }else{
TickTock 49:a3d2c5bb3cfa 659 kW[0]=0;
TickTock 49:a3d2c5bb3cfa 660 mpkWh[0]=0;
TickTock 49:a3d2c5bb3cfa 661 }
TickTock 49:a3d2c5bb3cfa 662 //mpkWh[0]=floor(mpkWh[0]*10+0.5)/10; // Round to nearest 10th
TickTock 49:a3d2c5bb3cfa 663 motorRPM=0;
TickTock 41:8d4609ea7259 664 numSsamples=0;
TickTock 40:0e6e71a7323f 665 mWs_x4=0;
TickTock 40:0e6e71a7323f 666 numWsamples=0;
TickTock 53:8a51361434ae 667 if(accOn||playbackEn){
TickTock 52:d5385fbf4ea1 668 for(i=1;i<39;i++){
TickTock 49:a3d2c5bb3cfa 669 average=mph[i]/timeConstant[i];
TickTock 49:a3d2c5bb3cfa 670 mph[i]-=average;
TickTock 52:d5385fbf4ea1 671 mph[i]+=mph[0];
TickTock 52:d5385fbf4ea1 672 mpkWh[i]=average;
TickTock 49:a3d2c5bb3cfa 673 average=kW[i]/timeConstant[i];
TickTock 49:a3d2c5bb3cfa 674 kW[i]-=average;
TickTock 52:d5385fbf4ea1 675 kW[i]+=kW[0];
TickTock 52:d5385fbf4ea1 676 mpkWh[i]/=average;
TickTock 49:a3d2c5bb3cfa 677 if (mpkWh[i]<0) {
TickTock 49:a3d2c5bb3cfa 678 mpkWh[i]=99;// negative means inf.
TickTock 49:a3d2c5bb3cfa 679 }
TickTock 49:a3d2c5bb3cfa 680 //mpkWh[i]=floor(mpkWh[i]*10+0.5)/10; // Round to nearest 10th
TickTock 52:d5385fbf4ea1 681 }
TickTock 49:a3d2c5bb3cfa 682 }
TickTock 49:a3d2c5bb3cfa 683 updateDTE=true;
TickTock 40:0e6e71a7323f 684 if(logCP)
TickTock 40:0e6e71a7323f 685 logPackVoltages(); // Turbo3
TickTock 34:4751a8259b18 686 tick=false;
TickTock 33:a277743ebdeb 687 }
TickTock 36:dbd39c315258 688
TickTock 39:eef8beac7411 689 display=display<1?display+1:0; // toggle display
TickTock 39:eef8beac7411 690 updateDisplay(display);
TickTock 39:eef8beac7411 691
TickTock 39:eef8beac7411 692 if(pollCP){ // We do this inside main loop instead of ticker so CAN RX will not be blocked
TickTock 39:eef8beac7411 693 sendCPreq(); // send cellpair data request.
TickTock 39:eef8beac7411 694 wait_ms(16);
TickTock 39:eef8beac7411 695 sendTreq(); //send temperature request
TickTock 39:eef8beac7411 696 pollCP=false;
TickTock 39:eef8beac7411 697 }
TickTock 39:eef8beac7411 698
TickTock 36:dbd39c315258 699 if(step){ // playback
TickTock 36:dbd39c315258 700 if(playbackOpen&&playbackEn){
TickTock 38:155ec32c5e91 701 for(i=0;i<120;i++){
TickTock 36:dbd39c315258 702 if(!feof(file)){
TickTock 37:fea2c1d52c5f 703 fscanf(file,"%5c%8c",&header,&data);
TickTock 37:fea2c1d52c5f 704 logCan(header[0],CANMessage(0x7ff&((header[4]<<8)+header[3]), data, 8));
TickTock 36:dbd39c315258 705 }else{
TickTock 36:dbd39c315258 706 fclose(file); // restart
TickTock 36:dbd39c315258 707 file = fopen("/usb/playback.alc", "rb");
TickTock 50:83d5864c64a0 708 lastDMode[whichTouched]=99;//force refresh
TickTock 36:dbd39c315258 709 spkr.beep(2000,0.25);
TickTock 36:dbd39c315258 710 }
TickTock 36:dbd39c315258 711 }
TickTock 36:dbd39c315258 712 }
TickTock 36:dbd39c315258 713 step=false;
TickTock 36:dbd39c315258 714 }
TickTock 37:fea2c1d52c5f 715
TickTock 2:71b1999a8ea5 716 } //while (true)
TickTock 0:1596b8644523 717 }