Tick Tock / Mbed 2 deprecated CANary_9341_test

test fork

Dependencies:   SPI_TFTx2 SPI_TFTx2_ILI9341 TFT_fonts TOUCH_TFTx2 mbed

Fork of CANary_9341 by Tick Tock

main.cpp@134:ad243e4f1a17, 2013-07-25 (annotated)

Committer:
TickTock
Date:
Thu Jul 25 14:32:54 2013 +0000
Revision:
134:ad243e4f1a17
Parent:
133:b0675d9d11dd
Child:
135:89986950d501
Added orange highlight if psi<32; Qualified max and min trip efficiency update with trips > 3 miles; Keep mbed asleep during charging (EVcan only) unless logging active; Added miles & kWh to trip log;

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