Dual CANbus monitor and instrumentation cluster

Dependencies:   SPI_TFTx2 TFT_fonts TOUCH_TFTx2 beep mbed

Fork of CANary by Tick Tock

Committer:
TickTock
Date:
Sun Jul 21 11:08:38 2013 +0000
Branch:
Metric
Revision:
125:f58b7ab2abee
Parent:
124:0d622967b764
Re-centered efficiency screen

Who changed what in which revision?

UserRevisionLine numberNew contents of line
TickTock 13:62e0f7f39ff5 1 // main.cpp
TickTock 108:29b5a760adc2 2 //
TickTock 4:8d7759f4fe7a 3 //To Do:
TickTock 33:a277743ebdeb 4 // * Audible friction brake feedback
TickTock 33:a277743ebdeb 5 // * User-configurable watchpoint
TickTock 33:a277743ebdeb 6 // * Add 50% charge option
TickTock 102:fd19f777a0b4 7 // * Add coasting regen to regen/braking display
TickTock 103:1389e9efe8c3 8 // * Change semilog efficiency graph to linear with 10 minute values
TickTock 102:fd19f777a0b4 9 // * Add additional 79b bank readouts
TickTock 102:fd19f777a0b4 10 // * Add ability to transfer settings config file to/from USB
TickTock 125:f58b7ab2abee 11 // * Subtract accessory power from efficiency history (add back in when displaying)
TickTock 13:62e0f7f39ff5 12
TickTock 12:8e42d7ba8468 13 #include "mbed.h"
TickTock 12:8e42d7ba8468 14 #include "CAN.h"
TickTock 12:8e42d7ba8468 15 #include "beep.h"
TickTock 109:3e6f0e8fca0d 16 #include "ff.h"
TickTock 12:8e42d7ba8468 17 #include "PowerControl.h"
TickTock 12:8e42d7ba8468 18 #include "EthernetPowerControl.h"
TickTock 12:8e42d7ba8468 19 #include "utility.h"
TickTock 12:8e42d7ba8468 20 #include "displayModes.h"
TickTock 23:cd03f9c3395e 21 #include "TOUCH_TFTx2.h"
TickTock 4:8d7759f4fe7a 22
TickTock 125:f58b7ab2abee 23 char revStr[7] = "125"; // gg - revision string, max 6 characters
TickTock 110:ffddff3ad2f2 24
TickTock 109:3e6f0e8fca0d 25 FATFS USBdrive;
TickTock 13:62e0f7f39ff5 26 LocalFileSystem local("local");
TickTock 109:3e6f0e8fca0d 27 bool waitasec = true;
TickTock 115:549410af477d 28 unsigned char wait5secs = 5;
TickTock 13:62e0f7f39ff5 29 // to write to USB Flash Drives, or equivalent (SD card in Reader/Writer)
TickTock 119:0e2b641e98a2 30 // class10 SDcard in Reader/Writer recommended
TickTock 111:d1559bb25c43 31 FRESULT mfr = f_mount(0,&USBdrive);
TickTock 13:62e0f7f39ff5 32 time_t seconds ;
TickTock 13:62e0f7f39ff5 33
TickTock 36:dbd39c315258 34 Ticker autoPoll;
TickTock 36:dbd39c315258 35 Ticker playback;
TickTock 78:a383971fe02f 36 Ticker msgReq;
TickTock 13:62e0f7f39ff5 37 Timer timer;
TickTock 13:62e0f7f39ff5 38
TickTock 13:62e0f7f39ff5 39 DigitalOut led1(LED1);
TickTock 13:62e0f7f39ff5 40 DigitalOut led2(LED2);
TickTock 13:62e0f7f39ff5 41 DigitalOut led3(LED3);
TickTock 13:62e0f7f39ff5 42 DigitalOut led4(LED4);
TickTock 13:62e0f7f39ff5 43
TickTock 13:62e0f7f39ff5 44 InterruptIn touchpad(p17);
TickTock 13:62e0f7f39ff5 45 CAN can1(p9, p10); // CAN1 (EV) uses pins 9 and 10 (rx, tx) and pin 8 (rs)
TickTock 13:62e0f7f39ff5 46 DigitalOut can1SleepMode(p8); // Use pin 8 to control the sleep mode of can2
TickTock 13:62e0f7f39ff5 47 CAN can2(p30, p29); // CAN2 (CAR) uses pins 30 and 29 (rx, tx) and pin 28 (rs)
TickTock 13:62e0f7f39ff5 48 DigitalOut can2SleepMode(p28); // Use pin 28 to control the sleep mode of can1
TickTock 35:5acbd8a64a89 49 AnalogIn mon12V(p15);
TickTock 13:62e0f7f39ff5 50 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 51 PwmOut dled(p23);
TickTock 35:5acbd8a64a89 52 Beep spkr(p21);
TickTock 13:62e0f7f39ff5 53
garygid 87:46ac3f2519d6 54 bool debugMode = false;
TickTock 108:29b5a760adc2 55 bool usbEn = false;
TickTock 108:29b5a760adc2 56 bool logEn = true;
TickTock 108:29b5a760adc2 57 bool logOpen = false;
TickTock 115:549410af477d 58 bool yesBattLog = true; // gg - Batt Log
TickTock 108:29b5a760adc2 59 unsigned char tNavRow = 3; // gg - 4x4 touch
garygid 54:6ce808d0995e 60
TickTock 109:3e6f0e8fca0d 61 FILE *hfile; // history file
TickTock 109:3e6f0e8fca0d 62 FIL efile; // external usb file
TickTock 109:3e6f0e8fca0d 63 FRESULT efr; // external file access flags
TickTock 109:3e6f0e8fca0d 64 unsigned int bytesRW;
TickTock 108:29b5a760adc2 65 char fileName[35] = "";
TickTock 84:fd21e5d32dab 66 char writeBuffer[maxBufLen][13] __attribute__ ((section("AHBSRAM1"))); // buffer for USB write
TickTock 13:62e0f7f39ff5 67 char indexLastMsg[0x800]={0}; // index table for last message
TickTock 13:62e0f7f39ff5 68 CANMessage lastMsg[100]; // table to store last message of eachtype
garygid 87:46ac3f2519d6 69
TickTock 124:0d622967b764 70 unsigned char battData[BatDataBufMax]={0}; // 7 * 0x3D = BatDataBufMax
garygid 87:46ac3f2519d6 71
TickTock 13:62e0f7f39ff5 72 unsigned char msgChanged[100]; // inidcates which bytes changed
TickTock 13:62e0f7f39ff5 73 char c;
TickTock 76:fb6779d0963e 74 volatile int writePointer = 0;
TickTock 76:fb6779d0963e 75 int readPointer=0;
TickTock 75:77bd26829dca 76 volatile unsigned short secsNoMsg = 0;
TickTock 75:77bd26829dca 77 volatile unsigned short secsNoTouch = 0;
TickTock 20:3bf176d14b14 78 volatile bool canIdle;
TickTock 20:3bf176d14b14 79 volatile bool userIdle;
TickTock 26:462ccb580472 80 bool touched=false; //flag to read touchscreen
TickTock 42:4533b13b297d 81 unsigned char whichTouched = 0;
TickTock 13:62e0f7f39ff5 82 char counter = 0;
TickTock 41:8d4609ea7259 83 unsigned char dMode[2] = {mainScreen,brakeScreen}; //display mode
TickTock 13:62e0f7f39ff5 84 unsigned char sMode = 0; // setup mode
TickTock 13:62e0f7f39ff5 85 unsigned char lastDMode[2] = {0,0}; //last screen mode
TickTock 25:ddf0ec209f03 86 unsigned char dtMode = 6;
TickTock 13:62e0f7f39ff5 87 char displayLog[20][40];
TickTock 13:62e0f7f39ff5 88 unsigned char displayLoc = 0;
leafman 98:9f8bab96edff 89 unsigned int fwCount=1;
TickTock 13:62e0f7f39ff5 90 unsigned char indexOffset = 1;
TickTock 13:62e0f7f39ff5 91 bool showCP = false;
TickTock 39:eef8beac7411 92 bool logCP = false; //Turbo3
TickTock 108:29b5a760adc2 93 bool logOnce = false;
TickTock 103:1389e9efe8c3 94 bool repeatPoll = true;
TickTock 34:4751a8259b18 95 bool headlights = false;
TickTock 34:4751a8259b18 96 bool tick = false;
garygid 69:6bfdfc002036 97 bool ZeroSecTick = false;
TickTock 35:5acbd8a64a89 98 float ledHi = 0.8; // Bright LED value (until config file read)
TickTock 35:5acbd8a64a89 99 float ledLo = 0.1; // Dim LED value (until config file read)
TickTock 35:5acbd8a64a89 100 unsigned short pollInt = 300; // polling interval=5 minutes (until config file read)
TickTock 35:5acbd8a64a89 101 bool accOn = false; // Accessories on
TickTock 49:a3d2c5bb3cfa 102 bool laccOn = false;
TickTock 35:5acbd8a64a89 103 float scale12V = 16.2; // R1:R2 ratio
TickTock 40:0e6e71a7323f 104 signed long mWs_x4 = 0;
TickTock 40:0e6e71a7323f 105 unsigned short numWsamples = 0;
TickTock 41:8d4609ea7259 106 unsigned short numSsamples = 0;
TickTock 35:5acbd8a64a89 107 float accV = 0;
TickTock 36:dbd39c315258 108 bool playbackEn = false;
TickTock 36:dbd39c315258 109 bool playbackOpen = false;
TickTock 117:49883c779a74 110 //float playbackInt = 0.05; //read messages every 50 ms
TickTock 78:a383971fe02f 111 float playbackInt = 0.005; //read messages every 5 ms
TickTock 36:dbd39c315258 112 bool step = false;
TickTock 37:fea2c1d52c5f 113 char header[5];
TickTock 36:dbd39c315258 114 char data[8];
TickTock 41:8d4609ea7259 115 signed long motorRPM;
garygid 65:821fc79cd7fe 116 unsigned char skin = ttSkin ;
TickTock 50:83d5864c64a0 117 unsigned char dtePeriod = 14; //ten minute averaging interval
TickTock 107:e9be732c1ad4 118 float kWh_trip[3]={0};
TickTock 107:e9be732c1ad4 119 float miles_trip[3]={0};
TickTock 49:a3d2c5bb3cfa 120 float mph[39]={0};
TickTock 49:a3d2c5bb3cfa 121 float kW[39]={0};
TickTock 49:a3d2c5bb3cfa 122 float mpkWh[39]={0};
TickTock 120:041edeec08f5 123 float unloadedV_x2,Resr,curRmax,curRmin,redRmax,redRmin,incRmax,incRmin;
TickTock 121:553faf139a20 124 signed short Imax, Imin;
TickTock 49:a3d2c5bb3cfa 125 // Logarithmic division scale (roughly - snapped to common units of time)
TickTock 49:a3d2c5bb3cfa 126 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 127 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 128 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 129 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 130 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 121:553faf139a20 131 bool tock = false;
TickTock 73:62ee8eae3a84 132 unsigned short pointerSep;
TickTock 78:a383971fe02f 133 unsigned char reqMsgCnt = 99;
TickTock 102:fd19f777a0b4 134 unsigned long Ah_x10000 = 0;
TickTock 102:fd19f777a0b4 135 unsigned long SOC_x10000 = 0;
TickTock 102:fd19f777a0b4 136 unsigned short SOH_x100 = 0;
TickTock 108:29b5a760adc2 137 float maxTemp = 0;
leafman 98:9f8bab96edff 138 bool metric = false;
TickTock 121:553faf139a20 139 bool shunt[96]={0};
TickTock 121:553faf139a20 140 bool charging=false;
TickTock 124:0d622967b764 141
TickTock 0:1596b8644523 142 int main() {
TickTock 120:041edeec08f5 143 //can1SleepMode.mode(OpenDrain);
TickTock 120:041edeec08f5 144 //can2SleepMode.mode(OpenDrain);
TickTock 4:8d7759f4fe7a 145 char sTemp[40];
TickTock 2:71b1999a8ea5 146 unsigned long secs;
TickTock 49:a3d2c5bb3cfa 147 unsigned char i,j,display=0,lwt=0;
TickTock 22:a43df3905863 148 point lastTouch;
TickTock 52:d5385fbf4ea1 149 float average;
TickTock 3:3e879b043bc5 150 tt.set_orientation(1);
TickTock 4:8d7759f4fe7a 151 tt.background(Black);
TickTock 19:d576298c46f3 152 tt.set_display(2); // select both displays
TickTock 3:3e879b043bc5 153 tt.cls();
TickTock 1:9dcd70c32180 154 tt.claim(stdout); // send stdout to the TFT display
TickTock 12:8e42d7ba8468 155 touchpad.rise(&touch_ISR);
TickTock 4:8d7759f4fe7a 156 tt.wfi(); // enable interrupt on touch
TickTock 7:17bf9ceaf0aa 157 dled = 0.8; // turn on display LED 80%
TickTock 120:041edeec08f5 158 Resr = 0.075; // initial guess of Resr
TickTock 2:71b1999a8ea5 159 timer.start() ;
TickTock 2:71b1999a8ea5 160 RTC_Init(); // start the RTC Interrupts that sync the timer
TickTock 1:9dcd70c32180 161 struct tm t; // pointer to a static tm structure
TickTock 93:c2402e8cd0e2 162 NVIC_SetPriority(CAN_IRQn, 2); //set can priority just below RTC
TickTock 117:49883c779a74 163 NVIC_SetPriority(TIMER3_IRQn, 3); //set ticker priority just below can
TickTock 117:49883c779a74 164
TickTock 1:9dcd70c32180 165 seconds = time(NULL);
TickTock 1:9dcd70c32180 166 t = *localtime(&seconds) ;
TickTock 1:9dcd70c32180 167 // is it a date before 2012 ?
TickTock 26:462ccb580472 168 if ((t.tm_year + 1900) < 2012 ) {
TickTock 26:462ccb580472 169 // before 2013 so update year to make date entry easier
TickTock 26:462ccb580472 170 t.tm_year = 2013 - 1900;
TickTock 1:9dcd70c32180 171 // set the RTC
TickTock 1:9dcd70c32180 172 set_time(mktime(&t));
TickTock 1:9dcd70c32180 173 seconds = time(NULL);
TickTock 26:462ccb580472 174 }
TickTock 20:3bf176d14b14 175 t = *localtime(&seconds) ;
TickTock 20:3bf176d14b14 176 strftime(sTemp, 32, "%a %m/%d/%Y %X\n", &t);
TickTock 93:c2402e8cd0e2 177 printMsg(sTemp); // record RTC
garygid 54:6ce808d0995e 178
TickTock 62:ffd15edb5431 179 // revision
garygid 70:0700b769ac15 180 sprintf(sTemp,"CANary firmware rev%s\n", revStr); // gg - for Logging the revision
TickTock 93:c2402e8cd0e2 181 printMsg(sTemp); // revision
TickTock 15:a359fecf85ba 182
TickTock 26:462ccb580472 183 secsNoMsg = 0;
TickTock 43:e7f6f80590e3 184
TickTock 49:a3d2c5bb3cfa 185 //read efficiency history data
TickTock 97:a25940fd7b5b 186 hfile = fopen("/local/ehist.cny", "r");
TickTock 97:a25940fd7b5b 187 if (hfile!=NULL){ // found a efficiency history file
TickTock 92:935adef49ea4 188 for(i=0;i<39;i++){
TickTock 97:a25940fd7b5b 189 if(!feof(hfile)){
TickTock 97:a25940fd7b5b 190 fscanf(hfile,"%f %f\r\n",&mph[i],&kW[i]);
TickTock 49:a3d2c5bb3cfa 191 mpkWh[i]=mph[i]/kW[i];
TickTock 49:a3d2c5bb3cfa 192 }
TickTock 49:a3d2c5bb3cfa 193 }
TickTock 97:a25940fd7b5b 194 fclose(hfile);
TickTock 116:5cd72bae7c12 195 printMsg("History Loaded.\n"); // History loaded
TickTock 49:a3d2c5bb3cfa 196 } else { // create initial file
TickTock 116:5cd72bae7c12 197 printMsg("History not found. Created.\n"); // history not found, created
TickTock 92:935adef49ea4 198 for(i=0;i<39;i++){
TickTock 49:a3d2c5bb3cfa 199 // Pre-load with 4 mpkWh @ 40 mph
TickTock 49:a3d2c5bb3cfa 200 mph[i]=40*timeConstant[i];
TickTock 49:a3d2c5bb3cfa 201 kW[i]=10*timeConstant[i];
TickTock 49:a3d2c5bb3cfa 202 mpkWh[i]=4;
TickTock 49:a3d2c5bb3cfa 203 }
TickTock 49:a3d2c5bb3cfa 204 }
TickTock 49:a3d2c5bb3cfa 205
TickTock 46:73e8716f976f 206 // Read config file
TickTock 46:73e8716f976f 207 readConfig();
TickTock 108:29b5a760adc2 208 if (repeatPoll) { // enable autopolling if enabled
TickTock 108:29b5a760adc2 209 autoPoll.attach(&autoPollISR,pollInt);
TickTock 108:29b5a760adc2 210 }
TickTock 108:29b5a760adc2 211
TickTock 77:7c136766466c 212 // Start monitors
TickTock 77:7c136766466c 213 can1.monitor(true); // set to snoop mode
TickTock 77:7c136766466c 214 can2.monitor(true); // set to snoop mode
TickTock 77:7c136766466c 215 can1.frequency(500000);
TickTock 77:7c136766466c 216 can2.frequency(500000);
TickTock 120:041edeec08f5 217 can1SleepMode = VP230Sleep; // Turn on Monitor_only Mode
TickTock 120:041edeec08f5 218 can2SleepMode = VP230Sleep; // Turn on Monitor_only Mode
TickTock 77:7c136766466c 219 can1.attach(&recieve1);
TickTock 77:7c136766466c 220 can2.attach(&recieve2);
TickTock 77:7c136766466c 221
TickTock 26:462ccb580472 222 touched=false;
TickTock 26:462ccb580472 223 secsNoTouch=2;
TickTock 2:71b1999a8ea5 224 while (true) {
TickTock 4:8d7759f4fe7a 225 if (!logOpen) { // Open new file if one is not already open
TickTock 112:b41b35401eb6 226 if(logEn&&usbEn){ //logging enables and USB device detected
TickTock 109:3e6f0e8fca0d 227 strftime(fileName, 32, "%m%d%H%M.alc", &t); //mmddhhmm.alc
TickTock 109:3e6f0e8fca0d 228 efr = f_open(&efile,fileName,FA_WRITE|FA_OPEN_ALWAYS);
TickTock 7:17bf9ceaf0aa 229 seconds = time(NULL);
TickTock 7:17bf9ceaf0aa 230 t = *localtime(&seconds) ;
TickTock 94:c3a14b3975d6 231 lastDMode[0]=99;//force refresh
TickTock 94:c3a14b3975d6 232 lastDMode[1]=99;//force refresh
TickTock 109:3e6f0e8fca0d 233 if(efr != FR_OK){
TickTock 109:3e6f0e8fca0d 234 sprintf(sTemp,"\nERR:%d Unable to open %s\n\n\n\n",efr,fileName);
TickTock 93:c2402e8cd0e2 235 printMsg(sTemp); // cannot open alc file
TickTock 7:17bf9ceaf0aa 236 logEn=false;
TickTock 26:462ccb580472 237 spkr.beep(1000,0.25);
TickTock 109:3e6f0e8fca0d 238 wait_ms(500);
TickTock 109:3e6f0e8fca0d 239 spkr.beep(1000,0.25);
TickTock 7:17bf9ceaf0aa 240 } else {
TickTock 7:17bf9ceaf0aa 241 logOpen = true;
TickTock 7:17bf9ceaf0aa 242 readPointer=writePointer;
TickTock 7:17bf9ceaf0aa 243 sprintf(sTemp,"Starting Can Log %s\n",fileName);
TickTock 93:c2402e8cd0e2 244 printMsg(sTemp); // starting alc log file
garygid 69:6bfdfc002036 245
garygid 69:6bfdfc002036 246 logTS(); // Date Time at start
TickTock 93:c2402e8cd0e2 247 logEvent("Starting"); // Log startup msg for testing
garygid 69:6bfdfc002036 248 sprintf(sTemp,"Cr%s",revStr);
TickTock 108:29b5a760adc2 249 logEvent(sTemp); // gg - log firmware version
TickTock 26:462ccb580472 250 spkr.beep(2000,0.25);
TickTock 7:17bf9ceaf0aa 251 }
TickTock 108:29b5a760adc2 252 }//logging enabled and USB detected
TickTock 15:a359fecf85ba 253 } else { // if (logOpen)
TickTock 117:49883c779a74 254 pointerSep=(writePointer+maxBufLen-readPointer)%maxBufLen;
TickTock 117:49883c779a74 255 if (pointerSep>(maxBufLen/16)||canIdle||!logEn) {
TickTock 117:49883c779a74 256 // Dump buffer if > 1/16 full or canbus has stopped
TickTock 117:49883c779a74 257 //if (&efile == NULL) {
TickTock 117:49883c779a74 258 if (efr != FR_OK) {
TickTock 117:49883c779a74 259 logOpen = false;
TickTock 117:49883c779a74 260 printMsg("Failed to append log file.\n"); // failed to append
TickTock 117:49883c779a74 261 spkr.beep(3000,0.25);
TickTock 117:49883c779a74 262 spkr.beep(1500,0.25);
TickTock 117:49883c779a74 263 spkr.beep(750,0.25);
TickTock 117:49883c779a74 264 spkr.beep(375,0.25);
TickTock 117:49883c779a74 265 logEn=false;
TickTock 117:49883c779a74 266 } else {
TickTock 117:49883c779a74 267 while (readPointer != writePointer) {
TickTock 117:49883c779a74 268 efr=f_write(&efile,&writeBuffer[readPointer][0],13,&bytesRW);
TickTock 117:49883c779a74 269 if(++readPointer >= maxBufLen){
TickTock 117:49883c779a74 270 readPointer=0;
TickTock 117:49883c779a74 271 led4 = !led4;
TickTock 117:49883c779a74 272 }
TickTock 117:49883c779a74 273 }
TickTock 117:49883c779a74 274 }
TickTock 117:49883c779a74 275 } // if > 1/16 full, canbus has stopped, or logging stopped
TickTock 30:e633a63eb257 276 if (!logEn) {
TickTock 77:7c136766466c 277 sprintf(sTemp,"Stopping Can Log %s\n",fileName);
TickTock 93:c2402e8cd0e2 278 printMsg(sTemp); // stopping alc log file
TickTock 109:3e6f0e8fca0d 279 f_close(&efile);
TickTock 117:49883c779a74 280 logOpen=false;
TickTock 77:7c136766466c 281 pointerSep=0;
TickTock 108:29b5a760adc2 282 led4=false;
TickTock 30:e633a63eb257 283 }
TickTock 4:8d7759f4fe7a 284 } // if logOpen
TickTock 36:dbd39c315258 285 if (canIdle&&userIdle&&!playbackEn) { // canbus idle --> sleep to save power
TickTock 95:248b3c25a7df 286 if (repeatPoll) { // stop autopolling if enabled
TickTock 95:248b3c25a7df 287 autoPoll.detach();
TickTock 95:248b3c25a7df 288 }
TickTock 111:d1559bb25c43 289 if (logOpen){ //close file to dump buffer
TickTock 111:d1559bb25c43 290 f_close(&efile);
TickTock 111:d1559bb25c43 291 } // if (logOpen)
TickTock 20:3bf176d14b14 292 seconds = time(NULL);
TickTock 20:3bf176d14b14 293 t = *localtime(&seconds) ;
TickTock 21:22bdce9efcb5 294 strftime(sTemp, 40, "Sleeping: %a %m/%d/%Y %X\n", &t);
TickTock 93:c2402e8cd0e2 295 printMsg(sTemp); // sleeping date time
TickTock 25:ddf0ec209f03 296 updateDisplay(0); //Added for turbo3 who has a display override and wants to see the sleep message before going to sleep
TickTock 25:ddf0ec209f03 297 updateDisplay(1);
TickTock 4:8d7759f4fe7a 298 //LPC_RTC->CIIR=0x00; // block RTC interrupts
TickTock 4:8d7759f4fe7a 299 led1=0;
TickTock 4:8d7759f4fe7a 300 led2=0;
TickTock 4:8d7759f4fe7a 301 led3=0;
TickTock 4:8d7759f4fe7a 302 led4=0;
TickTock 4:8d7759f4fe7a 303 dled=0; // turn off display
TickTock 4:8d7759f4fe7a 304 secs = time(NULL); // seconds past 12:00:00 AM 1 Jan 1900
TickTock 22:a43df3905863 305 while (secsNoMsg>canTimeout && !touched) {
TickTock 4:8d7759f4fe7a 306 //DeepPowerDown();
TickTock 12:8e42d7ba8468 307 tt.wfi(); //enable touch interrupt
TickTock 21:22bdce9efcb5 308 //__wfi(); // freeze CPU and wait for interrupt (from canbus or touch)
TickTock 21:22bdce9efcb5 309 Sleep();
TickTock 4:8d7759f4fe7a 310 }
TickTock 97:a25940fd7b5b 311 lastDMode[0]=99;
TickTock 97:a25940fd7b5b 312 lastDMode[1]=99;
TickTock 43:e7f6f80590e3 313 secsNoTouch=2;
TickTock 4:8d7759f4fe7a 314 canIdle=secsNoMsg>canTimeout;
TickTock 7:17bf9ceaf0aa 315 dled=0.8; // turn on display LED
TickTock 20:3bf176d14b14 316 seconds = time(NULL);
TickTock 20:3bf176d14b14 317 t = *localtime(&seconds) ;
TickTock 21:22bdce9efcb5 318 strftime(sTemp, 40, "Waking: %a %m/%d/%Y %X\n", &t);
TickTock 93:c2402e8cd0e2 319 printMsg(sTemp); // wakeup date time
TickTock 4:8d7759f4fe7a 320 if (time(NULL)>(secs+1800)) {
TickTock 110:ffddff3ad2f2 321 if (logOpen){
TickTock 110:ffddff3ad2f2 322 f_close(&efile);
TickTock 110:ffddff3ad2f2 323 logOpen = false; // Start new file if asleep for more than 30 minutes
TickTock 110:ffddff3ad2f2 324 } // if (logOpen)
TickTock 4:8d7759f4fe7a 325 if (secsNoTouch>100) secsNoTouch = 100; // also mostly reset user Idle counter
TickTock 43:e7f6f80590e3 326 } else if (logOpen){ // insert timestamp on each wake if logging enabled (disabled for now)
TickTock 111:d1559bb25c43 327 efr = f_open(&efile,fileName,FA_WRITE|FA_OPEN_ALWAYS);
TickTock 111:d1559bb25c43 328 f_lseek(&efile,0xffffffff); // goto end of file (append existing)
TickTock 93:c2402e8cd0e2 329 logEvent("WakingUp"); // gg - use messeges
garygid 69:6bfdfc002036 330 logTS(); // Date-Time at wakeup
TickTock 4:8d7759f4fe7a 331 }
TickTock 95:248b3c25a7df 332 if (repeatPoll) { // re-enable autopolling if enabled
TickTock 124:0d622967b764 333 autoPoll.attach(&autoPollISR,pollInt);
TickTock 95:248b3c25a7df 334 }
TickTock 4:8d7759f4fe7a 335 } // if idle
TickTock 4:8d7759f4fe7a 336
TickTock 15:a359fecf85ba 337 if(touched){ // call touchscreen procedure if touch interrupt detected
TickTock 7:17bf9ceaf0aa 338 lastTouch = tt.get_touch();
TickTock 7:17bf9ceaf0aa 339 lastTouch = tt.to_pixel(lastTouch); // convert to pixel pos
TickTock 40:0e6e71a7323f 340 if((lastTouch.x!=639)&&(lastTouch.x!=319)&&(lastTouch.y!=239)){ // filter phantom touches
TickTock 43:e7f6f80590e3 341 if (userIdle) {
TickTock 43:e7f6f80590e3 342 secsNoTouch=2; // Ignore first touch if user idle
TickTock 43:e7f6f80590e3 343 userIdle=false;
TickTock 40:0e6e71a7323f 344 } else {
TickTock 43:e7f6f80590e3 345 secsNoTouch=0;
TickTock 40:0e6e71a7323f 346 }
TickTock 43:e7f6f80590e3 347 if (lastTouch.x>320){
TickTock 43:e7f6f80590e3 348 whichTouched=1;
TickTock 43:e7f6f80590e3 349 } else {
TickTock 43:e7f6f80590e3 350 whichTouched=0;
TickTock 43:e7f6f80590e3 351 }
TickTock 43:e7f6f80590e3 352 if (whichTouched!=lwt){
TickTock 43:e7f6f80590e3 353 lastDMode[lwt]=99; // Repaint lastTouched
TickTock 43:e7f6f80590e3 354 lwt=whichTouched;
TickTock 43:e7f6f80590e3 355 }
TickTock 43:e7f6f80590e3 356 sMode = 1;
TickTock 22:a43df3905863 357 }
TickTock 22:a43df3905863 358 //sprintf(sTemp,"%d,%d ",lastTouch.x,lastTouch.y);
TickTock 93:c2402e8cd0e2 359 //printMsg(sTemp); // touch x,y - for debug
TickTock 12:8e42d7ba8468 360 touched = false; // clear interrupt flag
TickTock 7:17bf9ceaf0aa 361 }
garygid 54:6ce808d0995e 362 //---------------
garygid 54:6ce808d0995e 363 // gg - 4x4 touch
TickTock 62:ffd15edb5431 364 //unsigned char tScrn = 0 ; // screen 0
garygid 54:6ce808d0995e 365 unsigned char tCol ;
garygid 54:6ce808d0995e 366 unsigned char tRow ;
garygid 54:6ce808d0995e 367
TickTock 4:8d7759f4fe7a 368 if (!userIdle) {
TickTock 4:8d7759f4fe7a 369 if (secsNoTouch<2) {// Recently touched
TickTock 4:8d7759f4fe7a 370 secsNoTouch +=2; // increment to prevent double touch
TickTock 43:e7f6f80590e3 371 sMode = 1;
TickTock 22:a43df3905863 372 //sprintf(sTemp,"button %d %d,%d %d\n",i,buttonX(lastTouch.x,3),buttonY(lastTouch.y,3),lastTouch.x);
TickTock 93:c2402e8cd0e2 373 //printMsg(sTemp); // button parms - for debug
TickTock 23:cd03f9c3395e 374 switch (sMode) {
TickTock 23:cd03f9c3395e 375 case 0: // no select
TickTock 23:cd03f9c3395e 376 break;
TickTock 63:aa3bf6a33635 377 case 1: // select screen
garygid 54:6ce808d0995e 378 //--------------
garygid 54:6ce808d0995e 379 // gg - 4x4 touch
garygid 54:6ce808d0995e 380 tCol = buttonX(lastTouch.x,4) ;
TickTock 62:ffd15edb5431 381 if( tCol >= 4 ){ tCol -= 4; } // touch is on screen 1
garygid 54:6ce808d0995e 382
garygid 54:6ce808d0995e 383 tRow = buttonY(lastTouch.y,4) ;
garygid 54:6ce808d0995e 384
TickTock 63:aa3bf6a33635 385 highlightButton( tCol,tRow, whichTouched, 4,4) ; // gg - highlight
garygid 58:4d06288d75a2 386
TickTock 63:aa3bf6a33635 387 if( tRow == tNavRow ) tRow = 7 ; // gg
garygid 54:6ce808d0995e 388 switch ( (tCol*10) + tRow ) {
garygid 54:6ce808d0995e 389 //---------------------------------
garygid 67:2022fce701d0 390 case 00: // top row, left button on screen 0 or 1
TickTock 42:4533b13b297d 391 if (dMode[whichTouched]==monitorScreen||dMode[whichTouched]==changedScreen) {
garygid 67:2022fce701d0 392 indexOffset=indexOffset>4?indexOffset-4:1;
garygid 67:2022fce701d0 393 } else if (dMode[whichTouched] == indexScreen) { // gg - index
garygid 67:2022fce701d0 394 dMode[whichTouched] = mainScreen ; // GoTo Main Screen
TickTock 73:62ee8eae3a84 395 sMode=0;
leafman 98:9f8bab96edff 396 } else if (dMode[whichTouched]==configScreen) {
TickTock 23:cd03f9c3395e 397 wait_ms(500);
TickTock 37:fea2c1d52c5f 398 tt.background(Black);
TickTock 23:cd03f9c3395e 399 tt.calibrate();
TickTock 42:4533b13b297d 400 } else if (dMode[whichTouched]==playbackScreen) { // slower
TickTock 36:dbd39c315258 401 playbackInt *=2;
TickTock 36:dbd39c315258 402 if(playbackEn){
TickTock 36:dbd39c315258 403 playback.detach();
TickTock 36:dbd39c315258 404 playback.attach(&playbackISR,playbackInt);
TickTock 36:dbd39c315258 405 }
TickTock 62:ffd15edb5431 406 } else {
TickTock 62:ffd15edb5431 407 lastDMode[whichTouched]=99;//repaint to clear highlight
TickTock 23:cd03f9c3395e 408 }
TickTock 23:cd03f9c3395e 409 break;
garygid 54:6ce808d0995e 410 //-----------------------------------------------
garygid 67:2022fce701d0 411 case 10: // 1,0 (col left of center,top row) on screen 0 or 1
TickTock 42:4533b13b297d 412 if (dMode[whichTouched]==changedScreen) {
TickTock 92:935adef49ea4 413 for(j=0;j<100;j++) msgChanged[j]=0; // clear changed data
TickTock 42:4533b13b297d 414 lastDMode[whichTouched]=99;//force refresh
garygid 67:2022fce701d0 415 } else if (dMode[whichTouched] == indexScreen) { // gg - index
TickTock 73:62ee8eae3a84 416 sMode=0;
garygid 67:2022fce701d0 417 dMode[whichTouched] = brakeScreen ; // GoTo Brake Screen
TickTock 42:4533b13b297d 418 } else if (dMode[whichTouched]==cpScreen) {
TickTock 78:a383971fe02f 419 reqMsgCnt=0;
TickTock 124:0d622967b764 420 msgReq.attach(&sendReq,0.015);
TickTock 48:d1ce92104a1f 421 } else if (dMode[whichTouched]==cpHistScreen) { // gg - hist
TickTock 78:a383971fe02f 422 reqMsgCnt=0;
TickTock 124:0d622967b764 423 msgReq.attach(&sendReq,0.015);
TickTock 48:d1ce92104a1f 424 } else if (dMode[whichTouched]==cpBarScreen) { // gg - cpbars
TickTock 78:a383971fe02f 425 reqMsgCnt=0;
TickTock 124:0d622967b764 426 msgReq.attach(&sendReq,0.015);
leafman 98:9f8bab96edff 427 } else if (dMode[whichTouched]==configScreen) {
TickTock 23:cd03f9c3395e 428 mbed_reset();
TickTock 42:4533b13b297d 429 } else if (dMode[whichTouched]==playbackScreen) { // pause/unpause
TickTock 36:dbd39c315258 430 playbackEn=!playbackEn;
TickTock 36:dbd39c315258 431 if(playbackEn){
TickTock 36:dbd39c315258 432 playback.attach(&playbackISR,playbackInt);
TickTock 62:ffd15edb5431 433 } else {
TickTock 36:dbd39c315258 434 playback.detach();
TickTock 36:dbd39c315258 435 }
TickTock 62:ffd15edb5431 436 } else {
TickTock 62:ffd15edb5431 437 lastDMode[whichTouched]=99;//repaint to clear highlight
TickTock 23:cd03f9c3395e 438 }
TickTock 62:ffd15edb5431 439
TickTock 23:cd03f9c3395e 440 break;
garygid 54:6ce808d0995e 441 //--------------------------------------
garygid 54:6ce808d0995e 442 case 20: // col 2 and row 0 on either screen 0 or 1
TickTock 42:4533b13b297d 443 if (dMode[whichTouched]==monitorScreen||dMode[whichTouched]==changedScreen) {
TickTock 23:cd03f9c3395e 444 indexOffset=indexOffset<77?indexOffset+4:80;
garygid 67:2022fce701d0 445 } else if (dMode[whichTouched] == indexScreen) { // gg - index
garygid 67:2022fce701d0 446 dMode[whichTouched] = effScreen ; // GoTo EFF Screen
TickTock 73:62ee8eae3a84 447 sMode=0;
leafman 98:9f8bab96edff 448 } else if (dMode[whichTouched]==configScreen) {
TickTock 116:5cd72bae7c12 449 printMsg("Saving config file.\n"); // saving config
TickTock 25:ddf0ec209f03 450 saveConfig();
TickTock 26:462ccb580472 451 spkr.beep(2000,0.25);
TickTock 42:4533b13b297d 452 } else if (dMode[whichTouched]==playbackScreen) { // faster
TickTock 36:dbd39c315258 453 if(playbackInt>.002){
TickTock 36:dbd39c315258 454 playbackInt/=2;
TickTock 36:dbd39c315258 455 if(playbackEn){
TickTock 36:dbd39c315258 456 playback.detach();
TickTock 36:dbd39c315258 457 playback.attach(&playbackISR,playbackInt);
TickTock 36:dbd39c315258 458 }
TickTock 36:dbd39c315258 459 }
TickTock 86:d1c9e8ac1c4b 460 } else {
TickTock 62:ffd15edb5431 461 lastDMode[whichTouched]=99;//repaint to clear highlight
TickTock 23:cd03f9c3395e 462 }
TickTock 62:ffd15edb5431 463
TickTock 23:cd03f9c3395e 464 break;
garygid 65:821fc79cd7fe 465
garygid 67:2022fce701d0 466 case 30: // right-most on top row
garygid 65:821fc79cd7fe 467
leafman 98:9f8bab96edff 468 if (dMode[whichTouched]==configScreen) {
garygid 65:821fc79cd7fe 469 // step through skins
garygid 65:821fc79cd7fe 470 if( skin < maxSkin ) skin += 1 ;
garygid 65:821fc79cd7fe 471 else skin = 0 ;
garygid 65:821fc79cd7fe 472
garygid 65:821fc79cd7fe 473 // repaint both screens, I think
garygid 65:821fc79cd7fe 474 lastDMode[whichTouched]=99;//repaint to clear highlight
garygid 65:821fc79cd7fe 475 // and re-paint the other screen too, to see new skin there
garygid 65:821fc79cd7fe 476 lastDMode[whichTouched ^ 1]=99; // repaint other screen (^ = XOR)
garygid 67:2022fce701d0 477 } else if (dMode[whichTouched] == indexScreen) { // gg - index
TickTock 122:138a40892a4c 478 dMode[whichTouched] = healthScreen ; // Goto health screen
TickTock 73:62ee8eae3a84 479 sMode=0;
TickTock 86:d1c9e8ac1c4b 480 } else {
garygid 65:821fc79cd7fe 481 lastDMode[whichTouched]=99;//repaint to clear highlight
garygid 65:821fc79cd7fe 482 }
garygid 65:821fc79cd7fe 483
garygid 65:821fc79cd7fe 484 break;
garygid 54:6ce808d0995e 485 //----------------------------------
garygid 54:6ce808d0995e 486 //----------------------------------
garygid 67:2022fce701d0 487 case 01: // left col middle row
leafman 98:9f8bab96edff 488 if (dMode[whichTouched]==configScreen) {
TickTock 23:cd03f9c3395e 489 logEn = !logEn;
garygid 67:2022fce701d0 490 } else if (dMode[whichTouched] == indexScreen) { // gg - index
TickTock 73:62ee8eae3a84 491 dMode[whichTouched] = cpScreen ; // GoTo CP Data Screen
TickTock 73:62ee8eae3a84 492 sMode=0;
TickTock 42:4533b13b297d 493 } else if (dMode[whichTouched]==dateScreen){
TickTock 25:ddf0ec209f03 494 dtMode=(dtMode<6)?dtMode+1:0;
TickTock 42:4533b13b297d 495 lastDMode[whichTouched]=99;
TickTock 62:ffd15edb5431 496 } else {
TickTock 62:ffd15edb5431 497 lastDMode[whichTouched]=99;//repaint to clear highlight
TickTock 23:cd03f9c3395e 498 }
TickTock 62:ffd15edb5431 499
TickTock 23:cd03f9c3395e 500 break;
garygid 54:6ce808d0995e 501 //------------------------------
TickTock 23:cd03f9c3395e 502 case 11:
leafman 98:9f8bab96edff 503 if (dMode[whichTouched]==configScreen){
TickTock 77:7c136766466c 504 repeatPoll = !repeatPoll;
TickTock 33:a277743ebdeb 505 if (repeatPoll) {
TickTock 36:dbd39c315258 506 autoPoll.attach(&autoPollISR,pollInt);
TickTock 33:a277743ebdeb 507 } else {
TickTock 36:dbd39c315258 508 autoPoll.detach();
TickTock 33:a277743ebdeb 509 }
garygid 67:2022fce701d0 510 } else if (dMode[whichTouched] == indexScreen) { // gg - index
garygid 67:2022fce701d0 511 dMode[whichTouched] = cpHistScreen ; // GoTo CP Hist Screen
TickTock 73:62ee8eae3a84 512 sMode=0;
TickTock 42:4533b13b297d 513 } else if (dMode[whichTouched]==playbackScreen) {
TickTock 36:dbd39c315258 514 // Start/stop playback
TickTock 36:dbd39c315258 515 if(!playbackOpen){
TickTock 125:f58b7ab2abee 516 if(!canIdle){
TickTock 125:f58b7ab2abee 517 printMsg("Cannot playback while connected to canbus\n");
TickTock 125:f58b7ab2abee 518 }else if(!logOpen){
TickTock 109:3e6f0e8fca0d 519 efr = f_open(&efile,"playback.alc",FA_READ|FA_OPEN_EXISTING);
TickTock 50:83d5864c64a0 520 lastDMode[whichTouched]=99;//force refresh
TickTock 109:3e6f0e8fca0d 521 if(efr != FR_OK){
TickTock 116:5cd72bae7c12 522 printMsg("Unable to open /usb/playback.alc\n"); // no playback.alc
TickTock 36:dbd39c315258 523 spkr.beep(1000,0.25);
TickTock 36:dbd39c315258 524 } else {
TickTock 36:dbd39c315258 525 playbackOpen = true;
TickTock 50:83d5864c64a0 526 playbackEn=true;
TickTock 50:83d5864c64a0 527 playback.attach(&playbackISR,playbackInt);
TickTock 116:5cd72bae7c12 528 printMsg("Starting playback\n"); // start playback
TickTock 36:dbd39c315258 529 spkr.beep(2000,0.25);
TickTock 36:dbd39c315258 530 can1.attach(&doNothing);// Stop recieving CAN data
TickTock 36:dbd39c315258 531 can2.attach(&doNothing);
TickTock 36:dbd39c315258 532 }
TickTock 36:dbd39c315258 533 } else {
TickTock 117:49883c779a74 534 printMsg("Must stop logging first\n");
TickTock 36:dbd39c315258 535 }
TickTock 36:dbd39c315258 536 } else {
TickTock 36:dbd39c315258 537 playback.detach();
TickTock 109:3e6f0e8fca0d 538 f_close(&efile);
TickTock 36:dbd39c315258 539 playbackOpen=false;
TickTock 50:83d5864c64a0 540 playbackEn=false;
TickTock 36:dbd39c315258 541 can1.attach(&recieve1);// Restore CAN data recieve
TickTock 36:dbd39c315258 542 can2.attach(&recieve2);
TickTock 42:4533b13b297d 543 lastDMode[whichTouched]=99;
TickTock 36:dbd39c315258 544 }
TickTock 42:4533b13b297d 545 } else if (dMode[whichTouched]==dateScreen){
TickTock 25:ddf0ec209f03 546 upDate(dtMode,true);
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 case 21: // col 2 row 1
leafman 98:9f8bab96edff 555 if (dMode[whichTouched]==configScreen) { // gg - Batt Log Enable Button
TickTock 48:d1ce92104a1f 556 yesBattLog = !yesBattLog;
garygid 67:2022fce701d0 557 } else if (dMode[whichTouched] == indexScreen) { // gg - index
garygid 67:2022fce701d0 558 dMode[whichTouched] = cpBarScreen ; // GoTo CP Bars Screen
TickTock 73:62ee8eae3a84 559 sMode=0;
TickTock 48:d1ce92104a1f 560 } else if (dMode[whichTouched]==dateScreen){
TickTock 25:ddf0ec209f03 561 upDate(dtMode,false);
TickTock 42:4533b13b297d 562 lastDMode[whichTouched]=99;
TickTock 62:ffd15edb5431 563 } else {
TickTock 62:ffd15edb5431 564 lastDMode[whichTouched]=99;//repaint to clear highlight
TickTock 25:ddf0ec209f03 565 }
TickTock 62:ffd15edb5431 566
TickTock 23:cd03f9c3395e 567 break;
garygid 54:6ce808d0995e 568
garygid 87:46ac3f2519d6 569 case 31: // col 3 row 1
leafman 98:9f8bab96edff 570 if (dMode[whichTouched]==configScreen) { // gg - Batt Log Enable Button
garygid 87:46ac3f2519d6 571 debugMode = !debugMode;
leafman 98:9f8bab96edff 572 } else if (dMode[whichTouched] == indexScreen) { // gg - index
leafman 98:9f8bab96edff 573 dMode[whichTouched] = configScreen ; // GoTo Config Screen
TickTock 107:e9be732c1ad4 574 } else if (dMode[whichTouched] == tripScreen) {
TickTock 108:29b5a760adc2 575 miles_trip[1]=0;
TickTock 108:29b5a760adc2 576 kWh_trip[1]=0;
TickTock 108:29b5a760adc2 577 sMode=0;
TickTock 108:29b5a760adc2 578 lastDMode[whichTouched]=99;//repaint to clear highlight
garygid 87:46ac3f2519d6 579 } else {
garygid 87:46ac3f2519d6 580 lastDMode[whichTouched]=99;//repaint to clear highlight
garygid 87:46ac3f2519d6 581 }
garygid 87:46ac3f2519d6 582 break;
garygid 87:46ac3f2519d6 583
garygid 54:6ce808d0995e 584 //-----------------------------------
garygid 67:2022fce701d0 585 case 02: // left col, bottom row (not nav)
garygid 67:2022fce701d0 586 if (dMode[whichTouched] == indexScreen) { // gg - index
leafman 98:9f8bab96edff 587 dMode[whichTouched] = playbackScreen ; // GoTo Playback Screen
leafman 98:9f8bab96edff 588 } else if (dMode[whichTouched]==configScreen) {
leafman 98:9f8bab96edff 589 metric = !metric; // toggle metric/imperial display
garygid 87:46ac3f2519d6 590 } else {
garygid 87:46ac3f2519d6 591 lastDMode[whichTouched]=99;//repaint to clear highlight
garygid 87:46ac3f2519d6 592 }
garygid 67:2022fce701d0 593 break;
garygid 67:2022fce701d0 594
garygid 67:2022fce701d0 595 case 12: // left-middle col, bottom row (not nav)
garygid 67:2022fce701d0 596 if (dMode[whichTouched] == indexScreen) { // gg - index
leafman 98:9f8bab96edff 597 dMode[whichTouched] = dateScreen ; // GoTo Set Date/Time Screen
garygid 87:46ac3f2519d6 598 } else {
garygid 87:46ac3f2519d6 599 lastDMode[whichTouched]=99;//repaint to clear highlight
garygid 87:46ac3f2519d6 600 }
garygid 67:2022fce701d0 601 break;
garygid 67:2022fce701d0 602
garygid 67:2022fce701d0 603 case 22: // right-middle col, bottom row (not nav)
garygid 67:2022fce701d0 604 if (dMode[whichTouched] == indexScreen) { // gg - index
leafman 98:9f8bab96edff 605 dMode[whichTouched] = logScreen ;
garygid 87:46ac3f2519d6 606 } else {
garygid 87:46ac3f2519d6 607 lastDMode[whichTouched]=99;//repaint to clear highlight
garygid 87:46ac3f2519d6 608 }
garygid 67:2022fce701d0 609 break;
TickTock 72:f9a6faa28873 610
leafman 98:9f8bab96edff 611 case 32: // right col, bottom row (not nav)
leafman 98:9f8bab96edff 612 if (dMode[whichTouched] == configScreen) {
TickTock 114:3f8c59a8a2b9 613 logEn=false;
leafman 98:9f8bab96edff 614 updateFirmware();
TickTock 107:e9be732c1ad4 615 } else if (dMode[whichTouched] == tripScreen) {
TickTock 108:29b5a760adc2 616 miles_trip[2]=0;
TickTock 108:29b5a760adc2 617 kWh_trip[2]=0;
TickTock 108:29b5a760adc2 618 sMode=0;
TickTock 108:29b5a760adc2 619 lastDMode[whichTouched]=99;//repaint to clear highlight
TickTock 108:29b5a760adc2 620 } else if (dMode[whichTouched] == indexScreen) {
TickTock 108:29b5a760adc2 621 dMode[whichTouched] = tripScreen ;
leafman 98:9f8bab96edff 622 } else {
garygid 87:46ac3f2519d6 623 lastDMode[whichTouched]=99;//repaint to clear highlight
leafman 98:9f8bab96edff 624 }
TickTock 72:f9a6faa28873 625 break;
TickTock 72:f9a6faa28873 626
garygid 67:2022fce701d0 627 //-----------------------------------
garygid 54:6ce808d0995e 628 //-----------------------------------
garygid 54:6ce808d0995e 629 // Prev Navigation
garygid 54:6ce808d0995e 630 case 07: // col 0 row tNavRow
TickTock 42:4533b13b297d 631 dMode[whichTouched]=dMode[whichTouched]>0?dMode[whichTouched]-1:maxScreens;
TickTock 22:a43df3905863 632 break;
garygid 54:6ce808d0995e 633 //-----------------------------------
garygid 54:6ce808d0995e 634 // Select Screen Navigation
garygid 54:6ce808d0995e 635 case 17:
TickTock 43:e7f6f80590e3 636 //secsNoTouch = userTimeout; // immediately exit config mode
TickTock 43:e7f6f80590e3 637 sMode=0;
TickTock 43:e7f6f80590e3 638 lastDMode[whichTouched]=99; // Repaint
TickTock 22:a43df3905863 639 break;
garygid 54:6ce808d0995e 640 //-----------------------------------
garygid 54:6ce808d0995e 641 // Index Navigation
garygid 54:6ce808d0995e 642 case 27: // col 2 row tNavRow
garygid 67:2022fce701d0 643 dMode[whichTouched]= indexScreen ; // gg - index
garygid 54:6ce808d0995e 644 break;
garygid 54:6ce808d0995e 645 //------------------------------------
garygid 54:6ce808d0995e 646 // Next Navigation
garygid 54:6ce808d0995e 647 case 37: // lower right on Nav Line gg - move next
TickTock 42:4533b13b297d 648 dMode[whichTouched]=dMode[whichTouched]<maxScreens?dMode[whichTouched]+1:0;
TickTock 22:a43df3905863 649 break;
garygid 54:6ce808d0995e 650 //------------------------------------
garygid 54:6ce808d0995e 651 //------------------------------------
TickTock 22:a43df3905863 652 default:
TickTock 62:ffd15edb5431 653 lastDMode[whichTouched]=99;//repaint to clear highlight
TickTock 25:ddf0ec209f03 654 break;
TickTock 25:ddf0ec209f03 655 }
TickTock 23:cd03f9c3395e 656 break;
TickTock 23:cd03f9c3395e 657 case 2: // numpad
TickTock 23:cd03f9c3395e 658 break;
TickTock 23:cd03f9c3395e 659 case 3:
TickTock 23:cd03f9c3395e 660 break;
TickTock 23:cd03f9c3395e 661 default:
TickTock 23:cd03f9c3395e 662 break;
TickTock 23:cd03f9c3395e 663 } // case sMode
TickTock 22:a43df3905863 664 } //recently touched
TickTock 4:8d7759f4fe7a 665 } else { // userIdle
TickTock 8:67eed72f3e10 666 if(sMode==1){
TickTock 8:67eed72f3e10 667 sMode=0;
TickTock 43:e7f6f80590e3 668 lastDMode[whichTouched]=99;
TickTock 8:67eed72f3e10 669 }
TickTock 4:8d7759f4fe7a 670 }
TickTock 34:4751a8259b18 671
TickTock 34:4751a8259b18 672 if(tick){ // Executes once a second
TickTock 108:29b5a760adc2 673 tick=false;
TickTock 93:c2402e8cd0e2 674 headlights = (lastMsg[indexLastMsg[0x358]].data[1]&0x80)?true:false; // headlight/turn signal indicator
TickTock 41:8d4609ea7259 675 accV=floor(mon12V*scale12V*10+0.5)/10; //Round to nearest 10th
TickTock 35:5acbd8a64a89 676 accOn=(accV>5)?true:false;
TickTock 121:553faf139a20 677 charging=(mph[0]<0.1)&&(kW[0]<-1); // not moving and generating energy so much be charging
TickTock 49:a3d2c5bb3cfa 678 if(laccOn&&!accOn){ // Car turned off
TickTock 108:29b5a760adc2 679 if (repeatPoll) { // Log on shutdown if autopoll enabled
TickTock 108:29b5a760adc2 680 tripLog(); // Write trip log on powerdown
TickTock 108:29b5a760adc2 681 }
TickTock 49:a3d2c5bb3cfa 682 //write efficiency history data
TickTock 97:a25940fd7b5b 683 hfile = fopen("/local/ehist.cny", "w");
TickTock 97:a25940fd7b5b 684 if (hfile!=NULL){ // found a efficiency history file
TickTock 92:935adef49ea4 685 for(i=0;i<39;i++){
TickTock 97:a25940fd7b5b 686 fprintf(hfile,"%f %f\r\n",mph[i],kW[i]);
TickTock 49:a3d2c5bb3cfa 687 }
TickTock 97:a25940fd7b5b 688 fclose(hfile);
TickTock 49:a3d2c5bb3cfa 689 }
TickTock 49:a3d2c5bb3cfa 690 }
TickTock 107:e9be732c1ad4 691 if(!laccOn&&accOn){ // Car turned on
TickTock 108:29b5a760adc2 692 miles_trip[0]=0;
TickTock 108:29b5a760adc2 693 kWh_trip[0]=0;
TickTock 115:549410af477d 694 wait5secs=5;
TickTock 115:549410af477d 695 }
TickTock 115:549410af477d 696 laccOn=accOn;
TickTock 115:549410af477d 697 if(!accOn&&!logEn&&userIdle&&!playbackEn){ // Car off and logging disabled and no user activity
TickTock 115:549410af477d 698 dled = 0;
TickTock 115:549410af477d 699 }else if(!headlights){
TickTock 115:549410af477d 700 dled = ledHi;
TickTock 115:549410af477d 701 } else {
TickTock 115:549410af477d 702 dled = ledLo;
TickTock 115:549410af477d 703 }
TickTock 115:549410af477d 704 if(wait5secs>0){ // Wait a few seconds after poweron to give BMS time to measure CP's
TickTock 115:549410af477d 705 wait5secs-=1;
TickTock 115:549410af477d 706 if (repeatPoll&&(wait5secs==0)) { // Poll on startup if autopoll enabled
TickTock 108:29b5a760adc2 707 logOnce=true;
TickTock 112:b41b35401eb6 708 reqMsgCnt=0;
TickTock 124:0d622967b764 709 msgReq.attach(&sendReq,0.015);
TickTock 108:29b5a760adc2 710 }
TickTock 107:e9be732c1ad4 711 }
TickTock 115:549410af477d 712
TickTock 49:a3d2c5bb3cfa 713 //compute historic efficiency
TickTock 41:8d4609ea7259 714 if(numSsamples>0){ // Avoid div0
TickTock 115:549410af477d 715 mph[0]=((float) motorRPM)/numSsamples/220; // Empirically derived with MXV4s - may change with different wheels&tires
TickTock 86:d1c9e8ac1c4b 716 } else {
TickTock 49:a3d2c5bb3cfa 717 mph[0]=0;
TickTock 36:dbd39c315258 718 }
TickTock 49:a3d2c5bb3cfa 719 if(mph[0]>99){
TickTock 49:a3d2c5bb3cfa 720 mph[0]=0;
TickTock 49:a3d2c5bb3cfa 721 }
TickTock 121:553faf139a20 722 numSsamples=0;
TickTock 107:e9be732c1ad4 723
TickTock 41:8d4609ea7259 724 if(numWsamples>0){ // Avoid div0
TickTock 121:553faf139a20 725 mpkWh[0]=mph[0];
TickTock 49:a3d2c5bb3cfa 726 kW[0]=((float) mWs_x4)/numWsamples/4e3;
TickTock 49:a3d2c5bb3cfa 727 mpkWh[0]/=kW[0];
TickTock 49:a3d2c5bb3cfa 728 if (mpkWh[0]<0) {
TickTock 49:a3d2c5bb3cfa 729 mpkWh[0]=99;// negative means inf.
TickTock 49:a3d2c5bb3cfa 730 }
TickTock 86:d1c9e8ac1c4b 731 } else {
TickTock 49:a3d2c5bb3cfa 732 kW[0]=0;
TickTock 49:a3d2c5bb3cfa 733 mpkWh[0]=0;
TickTock 49:a3d2c5bb3cfa 734 }
TickTock 121:553faf139a20 735 numWsamples=0;
TickTock 121:553faf139a20 736
TickTock 121:553faf139a20 737 if (!charging){
TickTock 121:553faf139a20 738 miles_trip[0]+=mph[0]/3600;
TickTock 121:553faf139a20 739 miles_trip[1]+=mph[0]/3600;
TickTock 121:553faf139a20 740 miles_trip[2]+=mph[0]/3600;
TickTock 121:553faf139a20 741 kWh_trip[0]+=kW[0]/3600;
TickTock 121:553faf139a20 742 kWh_trip[1]+=kW[0]/3600;
TickTock 121:553faf139a20 743 kWh_trip[2]+=kW[0]/3600;
TickTock 121:553faf139a20 744 }
TickTock 121:553faf139a20 745
TickTock 49:a3d2c5bb3cfa 746 motorRPM=0;
TickTock 40:0e6e71a7323f 747 mWs_x4=0;
TickTock 121:553faf139a20 748
TickTock 121:553faf139a20 749 // Compute ESR
TickTock 121:553faf139a20 750 if((Imax-Imin)<40){ // do nothing - insufficient delta_I to measure
TickTock 121:553faf139a20 751 unloadedV_x2 = (curRmax+curRmin)/2;
TickTock 120:041edeec08f5 752 }else if ((redRmax-redRmin)<(curRmax-curRmin)) {
TickTock 120:041edeec08f5 753 Resr-=0.001;
TickTock 120:041edeec08f5 754 unloadedV_x2 = (redRmax+redRmin)/2;
TickTock 120:041edeec08f5 755 } else if ((incRmax-incRmin)<(curRmax-curRmin)) {
TickTock 120:041edeec08f5 756 Resr+=0.001;
TickTock 120:041edeec08f5 757 unloadedV_x2 = (incRmax+incRmin)/2;
TickTock 120:041edeec08f5 758 } else {
TickTock 120:041edeec08f5 759 unloadedV_x2 = (curRmax+curRmin)/2;
TickTock 120:041edeec08f5 760 }
TickTock 120:041edeec08f5 761 curRmin=1000;
TickTock 120:041edeec08f5 762 curRmax=0;
TickTock 120:041edeec08f5 763 incRmin=1000;
TickTock 120:041edeec08f5 764 incRmax=0;
TickTock 120:041edeec08f5 765 redRmin=1000;
TickTock 120:041edeec08f5 766 redRmax=0;
TickTock 121:553faf139a20 767 Imax=-1000;
TickTock 121:553faf139a20 768 Imin=1000;
TickTock 121:553faf139a20 769
TickTock 121:553faf139a20 770 if((accOn||playbackEn)&&!charging){
TickTock 92:935adef49ea4 771 for(i=1;i<39;i++){
TickTock 49:a3d2c5bb3cfa 772 average=mph[i]/timeConstant[i];
TickTock 49:a3d2c5bb3cfa 773 mph[i]-=average;
TickTock 52:d5385fbf4ea1 774 mph[i]+=mph[0];
TickTock 52:d5385fbf4ea1 775 mpkWh[i]=average;
TickTock 49:a3d2c5bb3cfa 776 average=kW[i]/timeConstant[i];
TickTock 121:553faf139a20 777 if(!charging){ //Not charging - so include in efficiency data
TickTock 97:a25940fd7b5b 778 kW[i]-=average;
TickTock 97:a25940fd7b5b 779 kW[i]+=kW[0];
TickTock 97:a25940fd7b5b 780 }
TickTock 52:d5385fbf4ea1 781 mpkWh[i]/=average;
TickTock 49:a3d2c5bb3cfa 782 if (mpkWh[i]<0) {
TickTock 49:a3d2c5bb3cfa 783 mpkWh[i]=99;// negative means inf.
TickTock 49:a3d2c5bb3cfa 784 }
TickTock 49:a3d2c5bb3cfa 785 //mpkWh[i]=floor(mpkWh[i]*10+0.5)/10; // Round to nearest 10th
TickTock 52:d5385fbf4ea1 786 }
TickTock 49:a3d2c5bb3cfa 787 }
TickTock 108:29b5a760adc2 788 if(logCP&&usbEn){
TickTock 108:29b5a760adc2 789 if(logOnce){
TickTock 108:29b5a760adc2 790 tripLog();
TickTock 108:29b5a760adc2 791 logOnce=false;
TickTock 108:29b5a760adc2 792 }
garygid 69:6bfdfc002036 793 logPackVoltages(); // Turbo3, only call
TickTock 108:29b5a760adc2 794 }
TickTock 112:b41b35401eb6 795 if(!usbEn&&!waitasec){
TickTock 108:29b5a760adc2 796 usbEn=detectUSB(); // Keep looking if none found
TickTock 108:29b5a760adc2 797 }
TickTock 111:d1559bb25c43 798 waitasec=false; // work around to avoid hang when USB tries to init immediately
TickTock 121:553faf139a20 799 tock=true;
TickTock 121:553faf139a20 800 } // tick
TickTock 36:dbd39c315258 801
TickTock 39:eef8beac7411 802 display=display<1?display+1:0; // toggle display
TickTock 39:eef8beac7411 803 updateDisplay(display);
TickTock 39:eef8beac7411 804
TickTock 36:dbd39c315258 805 if(step){ // playback
TickTock 36:dbd39c315258 806 if(playbackOpen&&playbackEn){
TickTock 92:935adef49ea4 807 for(i=0;i<120;i++){
TickTock 109:3e6f0e8fca0d 808 if(!f_eof(&efile)){
TickTock 109:3e6f0e8fca0d 809 efr=f_read(&efile,&header,5,&bytesRW);
TickTock 109:3e6f0e8fca0d 810 efr=f_read(&efile,&data,8,&bytesRW);
garygid 69:6bfdfc002036 811 logCan(header[0],CANMessage(0x7ff&((header[4]<<8)+header[3]), data, 8)); // Playback
TickTock 86:d1c9e8ac1c4b 812 } else {
TickTock 109:3e6f0e8fca0d 813 f_close(&efile); // restart
TickTock 109:3e6f0e8fca0d 814 efr = f_open(&efile,"playback.alc",FA_READ|FA_OPEN_EXISTING);
TickTock 50:83d5864c64a0 815 lastDMode[whichTouched]=99;//force refresh
TickTock 36:dbd39c315258 816 spkr.beep(2000,0.25);
TickTock 36:dbd39c315258 817 }
TickTock 36:dbd39c315258 818 }
TickTock 36:dbd39c315258 819 }
TickTock 36:dbd39c315258 820 step=false;
TickTock 36:dbd39c315258 821 }
TickTock 37:fea2c1d52c5f 822
TickTock 2:71b1999a8ea5 823 } //while (true)
TickTock 0:1596b8644523 824 }