Tick Tock / Mbed 2 deprecated CANary_9341

Dual CANbus monitor and instrumentation cluster supporting ILI9341 display controller

Dependencies:   SPI_TFTx2_ILI9341 TOUCH_TFTx2_ILI9341 TFT_fonts mbed

Fork of CANary by Tick Tock

main.cpp@149:e9739523109f, 2013-09-25 (annotated)

Committer:
TickTock
Date:
Wed Sep 25 03:33:18 2013 +0000
Revision:
149:e9739523109f
Parent:
148:6e3b9135fad2
Child:
150:ef46ce63345c
Compensated DTE with air drag of current ambient temperature.

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