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@187:447874df5cbe, 2014-05-12 (annotated)

Committer:
TickTock
Date:
Mon May 12 11:32:13 2014 +0000
Revision:
187:447874df5cbe
Parent:
186:d1f9b57fdd27 
Added SPI_TFTx2 library.  Breaks compilation although not directly referenced.

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 166:ec3951ba9701 4 // * Fix USB hot plug (must reset every time USB plugged)
TickTock 33:a277743ebdeb 5 // * Add 50% charge option
TickTock 152:a4d66901785d 6 // * Add linear efficiency graph with 10 minute values
TickTock 146:88f7bda79d8e 7 // * Add in-device config editor
TickTock 149:e9739523109f 8 // * Change pack volt color when CVLI fails
TickTock 149:e9739523109f 9 // * 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 164:46ed06263b0e 10 // * Add on screen messages for heater on, etc, and use refresh feature above to clear in x seconds
TickTock 169:84d790ac18a2 11 // * Be more efficient with write buffer (use msgLen instead of always storing 8 bytes)
TickTock 157:1a100a5ed06f 12
TickTock 184:5ca7b78297fe 13 // rev184
TickTock 184:5ca7b78297fe 14 // Fixed wh adjustment algorithm
TickTock 134:ad243e4f1a17 15
TickTock 12:8e42d7ba8468 16 #include "mbed.h"
TickTock 12:8e42d7ba8468 17 #include "CAN.h"
TickTock 109:3e6f0e8fca0d 18 #include "ff.h"
TickTock 12:8e42d7ba8468 19 #include "PowerControl.h"
TickTock 12:8e42d7ba8468 20 #include "EthernetPowerControl.h"
TickTock 12:8e42d7ba8468 21 #include "utility.h"
TickTock 12:8e42d7ba8468 22 #include "displayModes.h"
TickTock 23:cd03f9c3395e 23 #include "TOUCH_TFTx2.h"
TickTock 172:53548bf8bf85 24
TickTock 184:5ca7b78297fe 25 char revStr[7] = "184";
TickTock 170:7ee98e3611bc 26 unsigned long maxTarget = 1000;
TickTock 109:3e6f0e8fca0d 27 FATFS USBdrive;
TickTock 13:62e0f7f39ff5 28 LocalFileSystem local("local");
TickTock 115:549410af477d 29 unsigned char wait5secs = 5;
TickTock 13:62e0f7f39ff5 30 // to write to USB Flash Drives, or equivalent (SD card in Reader/Writer)
TickTock 119:0e2b641e98a2 31 // class10 SDcard in Reader/Writer recommended
TickTock 111:d1559bb25c43 32 FRESULT mfr = f_mount(0,&USBdrive);
TickTock 13:62e0f7f39ff5 33 time_t seconds ;
TickTock 13:62e0f7f39ff5 34
TickTock 36:dbd39c315258 35 Ticker autoPoll;
TickTock 36:dbd39c315258 36 Ticker playback;
TickTock 78:a383971fe02f 37 Ticker msgReq;
TickTock 140:ab3e94eb0227 38 Ticker geiger;
TickTock 13:62e0f7f39ff5 39 Timer timer;
TickTock 13:62e0f7f39ff5 40
TickTock 13:62e0f7f39ff5 41 DigitalOut led1(LED1);
TickTock 13:62e0f7f39ff5 42 DigitalOut led2(LED2);
TickTock 13:62e0f7f39ff5 43 DigitalOut led3(LED3);
TickTock 13:62e0f7f39ff5 44 DigitalOut led4(LED4);
TickTock 13:62e0f7f39ff5 45
TickTock 13:62e0f7f39ff5 46 InterruptIn touchpad(p17);
TickTock 13:62e0f7f39ff5 47 CAN can1(p9, p10); // CAN1 (EV) uses pins 9 and 10 (rx, tx) and pin 8 (rs)
TickTock 13:62e0f7f39ff5 48 DigitalOut can1SleepMode(p8); // Use pin 8 to control the sleep mode of can2
TickTock 13:62e0f7f39ff5 49 CAN can2(p30, p29); // CAN2 (CAR) uses pins 30 and 29 (rx, tx) and pin 28 (rs)
TickTock 13:62e0f7f39ff5 50 DigitalOut can2SleepMode(p28); // Use pin 28 to control the sleep mode of can1
TickTock 35:5acbd8a64a89 51 AnalogIn mon12V(p15);
TickTock 186:d1f9b57fdd27 52 TOUCH_TFTx2 tt(p16, p17, p19, p20, p11, p12, p13, p6, p7, p5, p14, "TFT"); // x+, x-, y+, y-, mosi, miso, sclk, cs0, cs1, reset, dc
TickTock 35:5acbd8a64a89 53 PwmOut dled(p23);
TickTock 155:f31006516956 54 PwmOut spkr(p21);
TickTock 13:62e0f7f39ff5 55
garygid 87:46ac3f2519d6 56 bool debugMode = false;
TickTock 108:29b5a760adc2 57 bool usbEn = false;
TickTock 131:0d926c080a65 58 bool logEn = false;
TickTock 108:29b5a760adc2 59 bool logOpen = false;
TickTock 115:549410af477d 60 bool yesBattLog = true; // gg - Batt Log
TickTock 108:29b5a760adc2 61 unsigned char tNavRow = 3; // gg - 4x4 touch
TickTock 140:ab3e94eb0227 62 bool brakeMon = false; // disable until desired value read from config
TickTock 155:f31006516956 63 bool regenMon = false;
TickTock 159:577e9d015693 64 bool heaterMon = false;
TickTock 152:a4d66901785d 65 bool autoSync = false; // auto clock sync on powerup
TickTock 152:a4d66901785d 66 bool syncDone = true;
TickTock 159:577e9d015693 67 bool heaterOn = false;
TickTock 159:577e9d015693 68 bool lHeaterOn = false;
TickTock 164:46ed06263b0e 69 bool CCon = false;
TickTock 164:46ed06263b0e 70 bool lCCon = false;
garygid 54:6ce808d0995e 71
TickTock 109:3e6f0e8fca0d 72 FILE *hfile; // history file
TickTock 109:3e6f0e8fca0d 73 FIL efile; // external usb file
TickTock 109:3e6f0e8fca0d 74 FRESULT efr; // external file access flags
TickTock 109:3e6f0e8fca0d 75 unsigned int bytesRW;
TickTock 108:29b5a760adc2 76 char fileName[35] = "";
TickTock 84:fd21e5d32dab 77 char writeBuffer[maxBufLen][13] __attribute__ ((section("AHBSRAM1"))); // buffer for USB write
TickTock 13:62e0f7f39ff5 78 char indexLastMsg[0x800]={0}; // index table for last message
TickTock 13:62e0f7f39ff5 79 CANMessage lastMsg[100]; // table to store last message of eachtype
garygid 87:46ac3f2519d6 80
TickTock 124:0d622967b764 81 unsigned char battData[BatDataBufMax]={0}; // 7 * 0x3D = BatDataBufMax
garygid 87:46ac3f2519d6 82
TickTock 13:62e0f7f39ff5 83 unsigned char msgChanged[100]; // inidcates which bytes changed
TickTock 13:62e0f7f39ff5 84 char c;
TickTock 76:fb6779d0963e 85 volatile int writePointer = 0;
TickTock 76:fb6779d0963e 86 int readPointer=0;
TickTock 141:cf13a632ddb5 87 volatile unsigned short secsNoCarCanMsg = canTimeout;
TickTock 141:cf13a632ddb5 88 volatile unsigned short secsNoEvCanMsg = canTimeout;
TickTock 75:77bd26829dca 89 volatile unsigned short secsNoTouch = 0;
TickTock 132:08748a67280a 90 volatile bool carCanIdle,evCanIdle,userIdle;
TickTock 26:462ccb580472 91 bool touched=false; //flag to read touchscreen
TickTock 42:4533b13b297d 92 unsigned char whichTouched = 0;
TickTock 13:62e0f7f39ff5 93 char counter = 0;
TickTock 41:8d4609ea7259 94 unsigned char dMode[2] = {mainScreen,brakeScreen}; //display mode
TickTock 13:62e0f7f39ff5 95 unsigned char sMode = 0; // setup mode
TickTock 13:62e0f7f39ff5 96 unsigned char lastDMode[2] = {0,0}; //last screen mode
TickTock 131:0d926c080a65 97 unsigned char dtMode = 0;
TickTock 13:62e0f7f39ff5 98 char displayLog[20][40];
TickTock 13:62e0f7f39ff5 99 unsigned char displayLoc = 0;
leafman 98:9f8bab96edff 100 unsigned int fwCount=1;
TickTock 13:62e0f7f39ff5 101 unsigned char indexOffset = 1;
TickTock 13:62e0f7f39ff5 102 bool showCP = false;
TickTock 39:eef8beac7411 103 bool logCP = false; //Turbo3
TickTock 108:29b5a760adc2 104 bool logOnce = false;
TickTock 103:1389e9efe8c3 105 bool repeatPoll = true;
TickTock 34:4751a8259b18 106 bool headlights = false;
TickTock 140:ab3e94eb0227 107 bool miles_kmbar = true;
TickTock 34:4751a8259b18 108 bool tick = false;
garygid 69:6bfdfc002036 109 bool ZeroSecTick = false;
TickTock 35:5acbd8a64a89 110 float ledHi = 0.8; // Bright LED value (until config file read)
TickTock 35:5acbd8a64a89 111 float ledLo = 0.1; // Dim LED value (until config file read)
TickTock 35:5acbd8a64a89 112 unsigned short pollInt = 300; // polling interval=5 minutes (until config file read)
TickTock 35:5acbd8a64a89 113 bool accOn = false; // Accessories on
TickTock 49:a3d2c5bb3cfa 114 bool laccOn = false;
TickTock 35:5acbd8a64a89 115 float scale12V = 16.2; // R1:R2 ratio
TickTock 170:7ee98e3611bc 116 float kWperGid = 0.080;
TickTock 170:7ee98e3611bc 117 unsigned short startGids = 0; // Gids at start of trip
TickTock 177:6fda79c2fda1 118 unsigned short dailyGids = 0; // Gids per day
TickTock 172:53548bf8bf85 119 bool getGids = false;
TickTock 40:0e6e71a7323f 120 signed long mWs_x4 = 0;
TickTock 40:0e6e71a7323f 121 unsigned short numWsamples = 0;
TickTock 41:8d4609ea7259 122 unsigned short numSsamples = 0;
TickTock 35:5acbd8a64a89 123 float accV = 0;
TickTock 143:88b5155622a5 124 float accV2 = 0;
TickTock 161:71ac85d11f03 125 float CCkW = 0;
TickTock 36:dbd39c315258 126 bool playbackEn = false;
TickTock 36:dbd39c315258 127 bool playbackOpen = false;
TickTock 49:a3d2c5bb3cfa 128 //float playbackInt = 0.05; //read messages every 50 ms
TickTock 78:a383971fe02f 129 float playbackInt = 0.005; //read messages every 5 ms
TickTock 36:dbd39c315258 130 bool step = false;
TickTock 37:fea2c1d52c5f 131 char header[5];
TickTock 36:dbd39c315258 132 char data[8];
TickTock 174:cd27e80f197d 133 signed long motorRPM;
garygid 65:821fc79cd7fe 134 unsigned char skin = ttSkin ;
TickTock 50:83d5864c64a0 135 unsigned char dtePeriod = 14; //ten minute averaging interval
TickTock 176:9c19f9856c76 136 float CCkWh_trip[4]={0};
TickTock 176:9c19f9856c76 137 float kWh_trip[4]={0};
TickTock 176:9c19f9856c76 138 float miles_trip[4]={0};
TickTock 144:b0c9d30dd346 139 float curEff = 0;
TickTock 158:059abeb44ba1 140 float maxTripEff = 0;
TickTock 158:059abeb44ba1 141 float minTripEff = 5;
TickTock 167:58d4edf403d4 142 float maxTripMiles = 0;
TickTock 167:58d4edf403d4 143 float maxTripkWh = 1;
TickTock 167:58d4edf403d4 144 float maxTripCCkWh = 0;
TickTock 167:58d4edf403d4 145 float minTripMiles = 5;
TickTock 167:58d4edf403d4 146 float minTripkWh = 1;
TickTock 167:58d4edf403d4 147 float minTripCCkWh = 0;
TickTock 49:a3d2c5bb3cfa 148 float mph[39]={0};
TickTock 49:a3d2c5bb3cfa 149 float kW[39]={0};
TickTock 49:a3d2c5bb3cfa 150 float mpkWh[39]={0};
TickTock 162:c6545fc0164a 151 float mpkWh_noCC=0;
TickTock 120:041edeec08f5 152 float unloadedV_x2,Resr,curRmax,curRmin,redRmax,redRmin,incRmax,incRmin;
TickTock 121:553faf139a20 153 signed short Imax, Imin;
TickTock 49:a3d2c5bb3cfa 154 // Logarithmic division scale (roughly - snapped to common units of time)
TickTock 49:a3d2c5bb3cfa 155 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 156 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 157 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 158 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 159 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 160 bool tock = false;
TickTock 73:62ee8eae3a84 161 unsigned short pointerSep;
TickTock 78:a383971fe02f 162 unsigned char reqMsgCnt = 99;
TickTock 102:fd19f777a0b4 163 unsigned long Ah_x10000 = 0;
TickTock 102:fd19f777a0b4 164 unsigned long SOC_x10000 = 0;
TickTock 143:88b5155622a5 165 unsigned short SOH2_x100 = 0;
TickTock 108:29b5a760adc2 166 float maxTemp = 0;
leafman 98:9f8bab96edff 167 bool metric = false;
TickTock 121:553faf139a20 168 bool shunt[96]={0};
TickTock 121:553faf139a20 169 bool charging=false;
TickTock 131:0d926c080a65 170 bool showHealth=false;
TickTock 175:0357b4159b40 171 unsigned char saveDmode[2] = {99, 99};
TickTock 131:0d926c080a65 172 bool moving=false;
TickTock 140:ab3e94eb0227 173 unsigned short chirpInt;
TickTock 150:ef46ce63345c 174 unsigned short uMsgId[8] = {0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000}; // messages to display on debug screen msgId:byte
TickTock 152:a4d66901785d 175 unsigned short modelYear = 2011;
TickTock 153:e94cfe3c339c 176 bool idir, lidir;
TickTock 154:90ea16ca7475 177 bool enableSound=false;
TickTock 158:059abeb44ba1 178 bool clearTest=true;
TickTock 171:355e284f5201 179 unsigned long tbScalar = 72464;
TickTock 171:355e284f5201 180 unsigned long rbScalar = 8696;
TickTock 171:355e284f5201 181 unsigned long fbScalar = 132;
TickTock 177:6fda79c2fda1 182 int effCheckTime = 3;
TickTock 177:6fda79c2fda1 183 bool ignoreDayData = true;
TickTock 179:e4094e55f079 184 unsigned short cgids,lgids=0;
TickTock 179:e4094e55f079 185 unsigned short whpg[300]={0};
TickTock 180:5fdeeb86f3a3 186 float wh[300];
TickTock 180:5fdeeb86f3a3 187 float maxWhpg,minWh,whOff;
TickTock 13:62e0f7f39ff5 188
TickTock 0:1596b8644523 189 int main() {
TickTock 4:8d7759f4fe7a 190 char sTemp[40];
TickTock 2:71b1999a8ea5 191 unsigned long secs;
TickTock 179:e4094e55f079 192 unsigned short i,j;
TickTock 179:e4094e55f079 193 unsigned char display=0,lwt=0;
TickTock 22:a43df3905863 194 point lastTouch;
TickTock 52:d5385fbf4ea1 195 float average;
TickTock 3:3e879b043bc5 196 tt.set_orientation(1);
TickTock 4:8d7759f4fe7a 197 tt.background(Black);
TickTock 19:d576298c46f3 198 tt.set_display(2); // select both displays
TickTock 3:3e879b043bc5 199 tt.cls();
TickTock 137:70853cf5a30f 200 tt.foreground(White);
TickTock 137:70853cf5a30f 201 tt.set_font((unsigned char*) Arial12x12_prop); // select the font
TickTock 137:70853cf5a30f 202 tt.locate(0,0);
TickTock 1:9dcd70c32180 203 tt.claim(stdout); // send stdout to the TFT display
TickTock 137:70853cf5a30f 204 if(tt.is_touched()){ // If touching screen on poweron then update firmware
TickTock 137:70853cf5a30f 205 updateFirmware();
TickTock 137:70853cf5a30f 206 }
TickTock 12:8e42d7ba8468 207 touchpad.rise(&touch_ISR);
TickTock 4:8d7759f4fe7a 208 tt.wfi(); // enable interrupt on touch
TickTock 155:f31006516956 209 dled.period(0.001);
TickTock 154:90ea16ca7475 210 dled = ledHi; // turn on display LED 80%
TickTock 155:f31006516956 211 spkr = 0;
TickTock 120:041edeec08f5 212 Resr = 0.075; // initial guess of Resr
TickTock 2:71b1999a8ea5 213 timer.start() ;
TickTock 2:71b1999a8ea5 214 RTC_Init(); // start the RTC Interrupts that sync the timer
TickTock 176:9c19f9856c76 215 struct tm t,lt; // pointer to a static tm structure
TickTock 93:c2402e8cd0e2 216 NVIC_SetPriority(CAN_IRQn, 2); //set can priority just below RTC
TickTock 117:49883c779a74 217 NVIC_SetPriority(TIMER3_IRQn, 3); //set ticker priority just below can
TickTock 33:a277743ebdeb 218
TickTock 1:9dcd70c32180 219 seconds = time(NULL);
TickTock 177:6fda79c2fda1 220 t = *localtime(&seconds);
TickTock 177:6fda79c2fda1 221 lt = t; // initialize
TickTock 1:9dcd70c32180 222 // is it a date before 2012 ?
TickTock 26:462ccb580472 223 if ((t.tm_year + 1900) < 2012 ) {
TickTock 26:462ccb580472 224 // before 2013 so update year to make date entry easier
TickTock 26:462ccb580472 225 t.tm_year = 2013 - 1900;
TickTock 1:9dcd70c32180 226 // set the RTC
TickTock 1:9dcd70c32180 227 set_time(mktime(&t));
TickTock 1:9dcd70c32180 228 seconds = time(NULL);
TickTock 26:462ccb580472 229 }
TickTock 20:3bf176d14b14 230 t = *localtime(&seconds) ;
TickTock 20:3bf176d14b14 231 strftime(sTemp, 32, "%a %m/%d/%Y %X\n", &t);
TickTock 93:c2402e8cd0e2 232 printMsg(sTemp); // record RTC
garygid 54:6ce808d0995e 233
TickTock 62:ffd15edb5431 234 // revision
garygid 70:0700b769ac15 235 sprintf(sTemp,"CANary firmware rev%s\n", revStr); // gg - for Logging the revision
TickTock 93:c2402e8cd0e2 236 printMsg(sTemp); // revision
TickTock 17:e32324a2678d 237
TickTock 179:e4094e55f079 238 for(i=0;i<300;i++){ // initialize wh lookup
TickTock 181:396fdcceefd2 239 wh[i]=i*kWperGid*1000;
TickTock 179:e4094e55f079 240 }
TickTock 179:e4094e55f079 241
TickTock 49:a3d2c5bb3cfa 242 //read efficiency history data
TickTock 150:ef46ce63345c 243 hfile = fopen("/local/ehist.cny", "r");
TickTock 97:a25940fd7b5b 244 if (hfile!=NULL){ // found a efficiency history file
TickTock 49:a3d2c5bb3cfa 245 for(i=0;i<39;i++){
TickTock 97:a25940fd7b5b 246 if(!feof(hfile)){
TickTock 97:a25940fd7b5b 247 fscanf(hfile,"%f %f\r\n",&mph[i],&kW[i]);
TickTock 49:a3d2c5bb3cfa 248 mpkWh[i]=mph[i]/kW[i];
TickTock 166:ec3951ba9701 249 if(i==dtePeriod) mpkWh_noCC=mpkWh[i];
TickTock 49:a3d2c5bb3cfa 250 }
TickTock 49:a3d2c5bb3cfa 251 }
TickTock 134:ad243e4f1a17 252 if(!feof(hfile)){
TickTock 134:ad243e4f1a17 253 fscanf(hfile,"%f %f\r\n",&maxTripEff,&minTripEff);
TickTock 134:ad243e4f1a17 254 }
TickTock 155:f31006516956 255 if(!feof(hfile)){
TickTock 155:f31006516956 256 fscanf(hfile,"%f\r\n",&Resr);
TickTock 155:f31006516956 257 }
TickTock 167:58d4edf403d4 258 if(!feof(hfile)){
TickTock 167:58d4edf403d4 259 fscanf(hfile,"%f %f\r\n",&maxTripMiles,&minTripMiles);
TickTock 167:58d4edf403d4 260 }
TickTock 167:58d4edf403d4 261 if(!feof(hfile)){
TickTock 167:58d4edf403d4 262 fscanf(hfile,"%f %f\r\n",&maxTripkWh,&minTripkWh);
TickTock 167:58d4edf403d4 263 }
TickTock 167:58d4edf403d4 264 if(!feof(hfile)){
TickTock 167:58d4edf403d4 265 fscanf(hfile,"%f %f\r\n",&maxTripCCkWh,&minTripCCkWh);
TickTock 167:58d4edf403d4 266 }
TickTock 180:5fdeeb86f3a3 267 for(i=0;i<300;i++){
TickTock 180:5fdeeb86f3a3 268 if(feof(hfile)) break;
TickTock 180:5fdeeb86f3a3 269 fscanf(hfile,"%f\r\n",&wh[i]);
TickTock 179:e4094e55f079 270 }
TickTock 97:a25940fd7b5b 271 fclose(hfile);
TickTock 116:5cd72bae7c12 272 printMsg("History Loaded.\n"); // History loaded
TickTock 49:a3d2c5bb3cfa 273 } else { // create initial file
TickTock 116:5cd72bae7c12 274 printMsg("History not found. Created.\n"); // history not found, created
TickTock 49:a3d2c5bb3cfa 275 for(i=0;i<39;i++){
TickTock 49:a3d2c5bb3cfa 276 // Pre-load with 4 mpkWh @ 40 mph
TickTock 49:a3d2c5bb3cfa 277 mph[i]=40*timeConstant[i];
TickTock 49:a3d2c5bb3cfa 278 kW[i]=10*timeConstant[i];
TickTock 49:a3d2c5bb3cfa 279 mpkWh[i]=4;
TickTock 49:a3d2c5bb3cfa 280 }
TickTock 49:a3d2c5bb3cfa 281 }
TickTock 49:a3d2c5bb3cfa 282
TickTock 46:73e8716f976f 283 // Read config file
TickTock 46:73e8716f976f 284 readConfig();
TickTock 140:ab3e94eb0227 285 if (brakeMon){
TickTock 140:ab3e94eb0227 286 geiger.attach(&chirp,0.02);
TickTock 140:ab3e94eb0227 287 }
TickTock 108:29b5a760adc2 288 if (repeatPoll) { // enable autopolling if enabled
TickTock 108:29b5a760adc2 289 autoPoll.attach(&autoPollISR,pollInt);
TickTock 108:29b5a760adc2 290 }
TickTock 108:29b5a760adc2 291
TickTock 77:7c136766466c 292 // Start monitors
TickTock 77:7c136766466c 293 can1.monitor(true); // set to snoop mode
TickTock 77:7c136766466c 294 can2.monitor(true); // set to snoop mode
TickTock 77:7c136766466c 295 can1.frequency(500000);
TickTock 77:7c136766466c 296 can2.frequency(500000);
TickTock 120:041edeec08f5 297 can1SleepMode = VP230Sleep; // Turn on Monitor_only Mode
TickTock 120:041edeec08f5 298 can2SleepMode = VP230Sleep; // Turn on Monitor_only Mode
TickTock 77:7c136766466c 299 can1.attach(&recieve1);
TickTock 77:7c136766466c 300 can2.attach(&recieve2);
TickTock 77:7c136766466c 301
TickTock 26:462ccb580472 302 touched=false;
TickTock 26:462ccb580472 303 secsNoTouch=2;
TickTock 2:71b1999a8ea5 304 while (true) {
TickTock 4:8d7759f4fe7a 305 if (!logOpen) { // Open new file if one is not already open
TickTock 131:0d926c080a65 306 if(logEn&&usbEn){ //logging enabled and USB device detected
TickTock 109:3e6f0e8fca0d 307 strftime(fileName, 32, "%m%d%H%M.alc", &t); //mmddhhmm.alc
TickTock 109:3e6f0e8fca0d 308 efr = f_open(&efile,fileName,FA_WRITE|FA_OPEN_ALWAYS);
TickTock 7:17bf9ceaf0aa 309 seconds = time(NULL);
TickTock 7:17bf9ceaf0aa 310 t = *localtime(&seconds) ;
TickTock 94:c3a14b3975d6 311 lastDMode[0]=99;//force refresh
TickTock 94:c3a14b3975d6 312 lastDMode[1]=99;//force refresh
TickTock 109:3e6f0e8fca0d 313 if(efr != FR_OK){
TickTock 109:3e6f0e8fca0d 314 sprintf(sTemp,"\nERR:%d Unable to open %s\n\n\n\n",efr,fileName);
TickTock 93:c2402e8cd0e2 315 printMsg(sTemp); // cannot open alc file
TickTock 7:17bf9ceaf0aa 316 logEn=false;
TickTock 155:f31006516956 317 beep(1000,0.25);
TickTock 109:3e6f0e8fca0d 318 wait_ms(500);
TickTock 155:f31006516956 319 beep(1000,0.25);
TickTock 7:17bf9ceaf0aa 320 } else {
TickTock 7:17bf9ceaf0aa 321 logOpen = true;
TickTock 7:17bf9ceaf0aa 322 readPointer=writePointer;
TickTock 7:17bf9ceaf0aa 323 sprintf(sTemp,"Starting Can Log %s\n",fileName);
TickTock 93:c2402e8cd0e2 324 printMsg(sTemp); // starting alc log file
garygid 69:6bfdfc002036 325
garygid 69:6bfdfc002036 326 logTS(); // Date Time at start
TickTock 93:c2402e8cd0e2 327 logEvent("Starting"); // Log startup msg for testing
garygid 69:6bfdfc002036 328 sprintf(sTemp,"Cr%s",revStr);
TickTock 108:29b5a760adc2 329 logEvent(sTemp); // gg - log firmware version
TickTock 155:f31006516956 330 beep(2000,0.25);
TickTock 7:17bf9ceaf0aa 331 }
TickTock 108:29b5a760adc2 332 }//logging enabled and USB detected
TickTock 15:a359fecf85ba 333 } else { // if (logOpen)
TickTock 73:62ee8eae3a84 334 pointerSep=(writePointer+maxBufLen-readPointer)%maxBufLen;
TickTock 131:0d926c080a65 335 if (pointerSep>(maxBufLen/16)||carCanIdle||!logEn) {
TickTock 7:17bf9ceaf0aa 336 // Dump buffer if > 1/16 full or canbus has stopped
TickTock 117:49883c779a74 337 if (efr != FR_OK) {
TickTock 7:17bf9ceaf0aa 338 logOpen = false;
TickTock 117:49883c779a74 339 printMsg("Failed to append log file.\n"); // failed to append
TickTock 155:f31006516956 340 beep(3000,0.25);
TickTock 155:f31006516956 341 beep(1500,0.25);
TickTock 155:f31006516956 342 beep(750,0.25);
TickTock 155:f31006516956 343 beep(375,0.25);
TickTock 7:17bf9ceaf0aa 344 logEn=false;
TickTock 7:17bf9ceaf0aa 345 } else {
TickTock 7:17bf9ceaf0aa 346 while (readPointer != writePointer) {
TickTock 117:49883c779a74 347 efr=f_write(&efile,&writeBuffer[readPointer][0],13,&bytesRW);
TickTock 117:49883c779a74 348 if(++readPointer >= maxBufLen){
TickTock 117:49883c779a74 349 readPointer=0;
TickTock 117:49883c779a74 350 led4 = !led4;
TickTock 4:8d7759f4fe7a 351 }
TickTock 4:8d7759f4fe7a 352 }
TickTock 7:17bf9ceaf0aa 353 }
TickTock 30:e633a63eb257 354 } // if > 1/16 full, canbus has stopped, or logging stopped
TickTock 30:e633a63eb257 355 if (!logEn) {
TickTock 77:7c136766466c 356 sprintf(sTemp,"Stopping Can Log %s\n",fileName);
TickTock 93:c2402e8cd0e2 357 printMsg(sTemp); // stopping alc log file
TickTock 109:3e6f0e8fca0d 358 f_close(&efile);
TickTock 30:e633a63eb257 359 logOpen=false;
TickTock 77:7c136766466c 360 pointerSep=0;
TickTock 108:29b5a760adc2 361 led4=false;
TickTock 30:e633a63eb257 362 }
TickTock 4:8d7759f4fe7a 363 } // if logOpen
TickTock 132:08748a67280a 364 if (carCanIdle && (evCanIdle || !logOpen) && userIdle && !playbackEn) { // canbus idle --> sleep to save power
TickTock 95:248b3c25a7df 365 if (repeatPoll) { // stop autopolling if enabled
TickTock 95:248b3c25a7df 366 autoPoll.detach();
TickTock 95:248b3c25a7df 367 }
TickTock 111:d1559bb25c43 368 if (logOpen){ //close file to dump buffer
TickTock 111:d1559bb25c43 369 f_close(&efile);
TickTock 134:ad243e4f1a17 370 } else { //detach EVcan so only carcan will trigger wake
TickTock 134:ad243e4f1a17 371 can1.attach(NULL);
TickTock 134:ad243e4f1a17 372 }// if (logOpen)
TickTock 20:3bf176d14b14 373 seconds = time(NULL);
TickTock 20:3bf176d14b14 374 t = *localtime(&seconds) ;
TickTock 21:22bdce9efcb5 375 strftime(sTemp, 40, "Sleeping: %a %m/%d/%Y %X\n", &t);
TickTock 93:c2402e8cd0e2 376 printMsg(sTemp); // sleeping date time
TickTock 25:ddf0ec209f03 377 updateDisplay(0); //Added for turbo3 who has a display override and wants to see the sleep message before going to sleep
TickTock 25:ddf0ec209f03 378 updateDisplay(1);
TickTock 4:8d7759f4fe7a 379 //LPC_RTC->CIIR=0x00; // block RTC interrupts
TickTock 4:8d7759f4fe7a 380 led1=0;
TickTock 4:8d7759f4fe7a 381 led2=0;
TickTock 4:8d7759f4fe7a 382 led3=0;
TickTock 4:8d7759f4fe7a 383 led4=0;
TickTock 4:8d7759f4fe7a 384 dled=0; // turn off display
TickTock 4:8d7759f4fe7a 385 secs = time(NULL); // seconds past 12:00:00 AM 1 Jan 1900
TickTock 132:08748a67280a 386 while (secsNoCarCanMsg>canTimeout && (secsNoEvCanMsg>canTimeout || !logOpen) && !touched) {
TickTock 4:8d7759f4fe7a 387 //DeepPowerDown();
TickTock 12:8e42d7ba8468 388 tt.wfi(); //enable touch interrupt
TickTock 21:22bdce9efcb5 389 //__wfi(); // freeze CPU and wait for interrupt (from canbus or touch)
TickTock 21:22bdce9efcb5 390 Sleep();
TickTock 4:8d7759f4fe7a 391 }
TickTock 135:89986950d501 392 if (!logOpen){ // Re-attach EVcan
TickTock 134:ad243e4f1a17 393 can1.attach(&recieve1);
TickTock 134:ad243e4f1a17 394 }
TickTock 43:e7f6f80590e3 395 secsNoTouch=2;
TickTock 131:0d926c080a65 396 carCanIdle=secsNoCarCanMsg>canTimeout;
TickTock 132:08748a67280a 397 evCanIdle=secsNoEvCanMsg>canTimeout;
TickTock 154:90ea16ca7475 398 dled=ledHi; // turn on display LED
TickTock 20:3bf176d14b14 399 seconds = time(NULL);
TickTock 20:3bf176d14b14 400 t = *localtime(&seconds) ;
TickTock 21:22bdce9efcb5 401 strftime(sTemp, 40, "Waking: %a %m/%d/%Y %X\n", &t);
TickTock 93:c2402e8cd0e2 402 printMsg(sTemp); // wakeup date time
TickTock 4:8d7759f4fe7a 403 if (time(NULL)>(secs+1800)) {
TickTock 110:ffddff3ad2f2 404 if (logOpen){
TickTock 110:ffddff3ad2f2 405 f_close(&efile);
TickTock 110:ffddff3ad2f2 406 logOpen = false; // Start new file if asleep for more than 30 minutes
TickTock 110:ffddff3ad2f2 407 } // if (logOpen)
TickTock 4:8d7759f4fe7a 408 if (secsNoTouch>100) secsNoTouch = 100; // also mostly reset user Idle counter
TickTock 43:e7f6f80590e3 409 } else if (logOpen){ // insert timestamp on each wake if logging enabled (disabled for now)
TickTock 111:d1559bb25c43 410 efr = f_open(&efile,fileName,FA_WRITE|FA_OPEN_ALWAYS);
TickTock 111:d1559bb25c43 411 f_lseek(&efile,0xffffffff); // goto end of file (append existing)
TickTock 93:c2402e8cd0e2 412 logEvent("WakingUp"); // gg - use messeges
garygid 69:6bfdfc002036 413 logTS(); // Date-Time at wakeup
TickTock 4:8d7759f4fe7a 414 }
TickTock 95:248b3c25a7df 415 if (repeatPoll) { // re-enable autopolling if enabled
TickTock 124:0d622967b764 416 autoPoll.attach(&autoPollISR,pollInt);
TickTock 95:248b3c25a7df 417 }
TickTock 136:41a204105511 418 wait5secs=5; // Refresh screen after 5 seconds
TickTock 4:8d7759f4fe7a 419 } // if idle
TickTock 4:8d7759f4fe7a 420
TickTock 15:a359fecf85ba 421 if(touched){ // call touchscreen procedure if touch interrupt detected
TickTock 7:17bf9ceaf0aa 422 lastTouch = tt.get_touch();
TickTock 7:17bf9ceaf0aa 423 lastTouch = tt.to_pixel(lastTouch); // convert to pixel pos
TickTock 40:0e6e71a7323f 424 if((lastTouch.x!=639)&&(lastTouch.x!=319)&&(lastTouch.y!=239)){ // filter phantom touches
TickTock 43:e7f6f80590e3 425 if (userIdle) {
TickTock 43:e7f6f80590e3 426 secsNoTouch=2; // Ignore first touch if user idle
TickTock 43:e7f6f80590e3 427 userIdle=false;
TickTock 40:0e6e71a7323f 428 } else {
TickTock 43:e7f6f80590e3 429 secsNoTouch=0;
TickTock 40:0e6e71a7323f 430 }
TickTock 43:e7f6f80590e3 431 if (lastTouch.x>320){
TickTock 43:e7f6f80590e3 432 whichTouched=1;
TickTock 43:e7f6f80590e3 433 } else {
TickTock 43:e7f6f80590e3 434 whichTouched=0;
TickTock 43:e7f6f80590e3 435 }
TickTock 43:e7f6f80590e3 436 if (whichTouched!=lwt){
TickTock 43:e7f6f80590e3 437 lastDMode[lwt]=99; // Repaint lastTouched
TickTock 43:e7f6f80590e3 438 lwt=whichTouched;
TickTock 43:e7f6f80590e3 439 }
TickTock 43:e7f6f80590e3 440 sMode = 1;
TickTock 22:a43df3905863 441 }
TickTock 22:a43df3905863 442 //sprintf(sTemp,"%d,%d ",lastTouch.x,lastTouch.y);
TickTock 93:c2402e8cd0e2 443 //printMsg(sTemp); // touch x,y - for debug
TickTock 12:8e42d7ba8468 444 touched = false; // clear interrupt flag
TickTock 7:17bf9ceaf0aa 445 }
garygid 54:6ce808d0995e 446 //---------------
garygid 54:6ce808d0995e 447 // gg - 4x4 touch
TickTock 62:ffd15edb5431 448 //unsigned char tScrn = 0 ; // screen 0
garygid 54:6ce808d0995e 449 unsigned char tCol ;
garygid 54:6ce808d0995e 450 unsigned char tRow ;
garygid 54:6ce808d0995e 451
TickTock 4:8d7759f4fe7a 452 if (!userIdle) {
TickTock 4:8d7759f4fe7a 453 if (secsNoTouch<2) {// Recently touched
TickTock 4:8d7759f4fe7a 454 secsNoTouch +=2; // increment to prevent double touch
TickTock 43:e7f6f80590e3 455 sMode = 1;
TickTock 22:a43df3905863 456 //sprintf(sTemp,"button %d %d,%d %d\n",i,buttonX(lastTouch.x,3),buttonY(lastTouch.y,3),lastTouch.x);
TickTock 93:c2402e8cd0e2 457 //printMsg(sTemp); // button parms - for debug
TickTock 23:cd03f9c3395e 458 switch (sMode) {
TickTock 23:cd03f9c3395e 459 case 0: // no select
TickTock 23:cd03f9c3395e 460 break;
TickTock 63:aa3bf6a33635 461 case 1: // select screen
garygid 54:6ce808d0995e 462 //--------------
garygid 54:6ce808d0995e 463 // gg - 4x4 touch
garygid 54:6ce808d0995e 464 tCol = buttonX(lastTouch.x,4) ;
TickTock 62:ffd15edb5431 465 if( tCol >= 4 ){ tCol -= 4; } // touch is on screen 1
garygid 54:6ce808d0995e 466
garygid 54:6ce808d0995e 467 tRow = buttonY(lastTouch.y,4) ;
garygid 54:6ce808d0995e 468
TickTock 63:aa3bf6a33635 469 highlightButton( tCol,tRow, whichTouched, 4,4) ; // gg - highlight
garygid 58:4d06288d75a2 470
TickTock 63:aa3bf6a33635 471 if( tRow == tNavRow ) tRow = 7 ; // gg
garygid 54:6ce808d0995e 472 switch ( (tCol*10) + tRow ) {
garygid 54:6ce808d0995e 473 //---------------------------------
garygid 67:2022fce701d0 474 case 00: // top row, left button on screen 0 or 1
TickTock 42:4533b13b297d 475 if (dMode[whichTouched]==monitorScreen||dMode[whichTouched]==changedScreen) {
garygid 67:2022fce701d0 476 indexOffset=indexOffset>4?indexOffset-4:1;
garygid 67:2022fce701d0 477 } else if (dMode[whichTouched] == indexScreen) { // gg - index
garygid 67:2022fce701d0 478 dMode[whichTouched] = mainScreen ; // GoTo Main Screen
TickTock 73:62ee8eae3a84 479 sMode=0;
TickTock 157:1a100a5ed06f 480 } else if (dMode[whichTouched]==config2Screen) {
TickTock 23:cd03f9c3395e 481 wait_ms(500);
TickTock 37:fea2c1d52c5f 482 tt.background(Black);
TickTock 23:cd03f9c3395e 483 tt.calibrate();
TickTock 42:4533b13b297d 484 } else if (dMode[whichTouched]==playbackScreen) { // slower
TickTock 36:dbd39c315258 485 playbackInt *=2;
TickTock 36:dbd39c315258 486 if(playbackEn){
TickTock 36:dbd39c315258 487 playback.detach();
TickTock 36:dbd39c315258 488 playback.attach(&playbackISR,playbackInt);
TickTock 36:dbd39c315258 489 }
TickTock 62:ffd15edb5431 490 } else {
TickTock 62:ffd15edb5431 491 lastDMode[whichTouched]=99;//repaint to clear highlight
TickTock 23:cd03f9c3395e 492 }
TickTock 23:cd03f9c3395e 493 break;
garygid 54:6ce808d0995e 494 //-----------------------------------------------
garygid 67:2022fce701d0 495 case 10: // 1,0 (col left of center,top row) on screen 0 or 1
TickTock 42:4533b13b297d 496 if (dMode[whichTouched]==changedScreen) {
TickTock 23:cd03f9c3395e 497 for(j=0;j<100;j++) msgChanged[j]=0; // clear changed data
TickTock 42:4533b13b297d 498 lastDMode[whichTouched]=99;//force refresh
TickTock 169:84d790ac18a2 499 sMode=0;
garygid 67:2022fce701d0 500 } else if (dMode[whichTouched] == indexScreen) { // gg - index
TickTock 73:62ee8eae3a84 501 sMode=0;
garygid 67:2022fce701d0 502 dMode[whichTouched] = brakeScreen ; // GoTo Brake Screen
TickTock 42:4533b13b297d 503 } else if (dMode[whichTouched]==cpScreen) {
TickTock 78:a383971fe02f 504 reqMsgCnt=0;
TickTock 79:68f0dd8d1f19 505 msgReq.attach(&sendReq,0.015);
TickTock 48:d1ce92104a1f 506 } else if (dMode[whichTouched]==cpHistScreen) { // gg - hist
TickTock 78:a383971fe02f 507 reqMsgCnt=0;
TickTock 79:68f0dd8d1f19 508 msgReq.attach(&sendReq,0.015);
TickTock 48:d1ce92104a1f 509 } else if (dMode[whichTouched]==cpBarScreen) { // gg - cpbars
TickTock 78:a383971fe02f 510 reqMsgCnt=0;
TickTock 79:68f0dd8d1f19 511 msgReq.attach(&sendReq,0.015);
leafman 98:9f8bab96edff 512 } else if (dMode[whichTouched]==configScreen) {
TickTock 23:cd03f9c3395e 513 mbed_reset();
TickTock 157:1a100a5ed06f 514 } else if (dMode[whichTouched]==config2Screen) { // reset DTE Max/Min
TickTock 158:059abeb44ba1 515 maxTripEff = 0;
TickTock 158:059abeb44ba1 516 minTripEff = 5;
TickTock 161:71ac85d11f03 517 beep(2000,0.25);
TickTock 184:5ca7b78297fe 518 for(i=0;i<300;i++){ // initialize wh lookup
TickTock 184:5ca7b78297fe 519 wh[i]=i*kWperGid*1000;
TickTock 184:5ca7b78297fe 520 }
TickTock 42:4533b13b297d 521 } else if (dMode[whichTouched]==playbackScreen) { // pause/unpause
TickTock 36:dbd39c315258 522 playbackEn=!playbackEn;
TickTock 36:dbd39c315258 523 if(playbackEn){
TickTock 36:dbd39c315258 524 playback.attach(&playbackISR,playbackInt);
TickTock 62:ffd15edb5431 525 } else {
TickTock 36:dbd39c315258 526 playback.detach();
TickTock 36:dbd39c315258 527 }
TickTock 62:ffd15edb5431 528 } else {
TickTock 62:ffd15edb5431 529 lastDMode[whichTouched]=99;//repaint to clear highlight
TickTock 23:cd03f9c3395e 530 }
TickTock 62:ffd15edb5431 531
TickTock 23:cd03f9c3395e 532 break;
garygid 54:6ce808d0995e 533 //--------------------------------------
garygid 54:6ce808d0995e 534 case 20: // col 2 and row 0 on either screen 0 or 1
TickTock 42:4533b13b297d 535 if (dMode[whichTouched]==monitorScreen||dMode[whichTouched]==changedScreen) {
TickTock 23:cd03f9c3395e 536 indexOffset=indexOffset<77?indexOffset+4:80;
garygid 67:2022fce701d0 537 } else if (dMode[whichTouched] == indexScreen) { // gg - index
garygid 67:2022fce701d0 538 dMode[whichTouched] = effScreen ; // GoTo EFF Screen
TickTock 73:62ee8eae3a84 539 sMode=0;
leafman 98:9f8bab96edff 540 } else if (dMode[whichTouched]==configScreen) {
TickTock 143:88b5155622a5 541 dMode[whichTouched]=mainScreen;
TickTock 169:84d790ac18a2 542 //write efficiency history data
TickTock 169:84d790ac18a2 543 hfile = fopen("/local/ehist.cny", "w");
TickTock 169:84d790ac18a2 544 if (hfile!=NULL){ // found a efficiency history file
TickTock 169:84d790ac18a2 545 for(i=0;i<39;i++){
TickTock 169:84d790ac18a2 546 fprintf(hfile,"%f %f\r\n",mph[i],kW[i]);
TickTock 169:84d790ac18a2 547 }
TickTock 169:84d790ac18a2 548 fprintf(hfile,"%f %f\r\n",maxTripEff,minTripEff); // Save max and min
TickTock 169:84d790ac18a2 549 fprintf(hfile,"%f \r\n",Resr); // Save series resistance
TickTock 169:84d790ac18a2 550 fprintf(hfile,"%f %f\r\n",maxTripMiles,minTripMiles); // Save max and min
TickTock 169:84d790ac18a2 551 fprintf(hfile,"%f %f\r\n",maxTripkWh,minTripkWh); // Save max and min
TickTock 169:84d790ac18a2 552 fprintf(hfile,"%f %f\r\n",maxTripCCkWh,minTripCCkWh); // Save max and min
TickTock 180:5fdeeb86f3a3 553 for(i=0;i<300;i++){
TickTock 180:5fdeeb86f3a3 554 fprintf(hfile,"%f\r\n",wh[i]);
TickTock 180:5fdeeb86f3a3 555 }
TickTock 169:84d790ac18a2 556 fclose(hfile);
TickTock 169:84d790ac18a2 557 }
TickTock 169:84d790ac18a2 558 beep(2000,0.25);
TickTock 184:5ca7b78297fe 559 saveConfig();
TickTock 184:5ca7b78297fe 560 beep(2000,0.25);
TickTock 169:84d790ac18a2 561 } else if (dMode[whichTouched]==config2Screen) {
TickTock 169:84d790ac18a2 562 showHealth = !showHealth;
TickTock 42:4533b13b297d 563 } else if (dMode[whichTouched]==playbackScreen) { // faster
TickTock 36:dbd39c315258 564 if(playbackInt>.002){
TickTock 36:dbd39c315258 565 playbackInt/=2;
TickTock 36:dbd39c315258 566 if(playbackEn){
TickTock 36:dbd39c315258 567 playback.detach();
TickTock 36:dbd39c315258 568 playback.attach(&playbackISR,playbackInt);
TickTock 36:dbd39c315258 569 }
TickTock 36:dbd39c315258 570 }
TickTock 86:d1c9e8ac1c4b 571 } else {
TickTock 62:ffd15edb5431 572 lastDMode[whichTouched]=99;//repaint to clear highlight
TickTock 23:cd03f9c3395e 573 }
TickTock 62:ffd15edb5431 574
TickTock 23:cd03f9c3395e 575 break;
garygid 65:821fc79cd7fe 576
garygid 67:2022fce701d0 577 case 30: // right-most on top row
garygid 65:821fc79cd7fe 578
TickTock 157:1a100a5ed06f 579 if (dMode[whichTouched]==config2Screen) {
garygid 65:821fc79cd7fe 580 // step through skins
garygid 65:821fc79cd7fe 581 if( skin < maxSkin ) skin += 1 ;
garygid 65:821fc79cd7fe 582 else skin = 0 ;
garygid 65:821fc79cd7fe 583
garygid 65:821fc79cd7fe 584 // repaint both screens, I think
garygid 65:821fc79cd7fe 585 lastDMode[whichTouched]=99;//repaint to clear highlight
garygid 65:821fc79cd7fe 586 // and re-paint the other screen too, to see new skin there
garygid 65:821fc79cd7fe 587 lastDMode[whichTouched ^ 1]=99; // repaint other screen (^ = XOR)
garygid 67:2022fce701d0 588 } else if (dMode[whichTouched] == indexScreen) { // gg - index
TickTock 122:138a40892a4c 589 dMode[whichTouched] = healthScreen ; // Goto health screen
TickTock 73:62ee8eae3a84 590 sMode=0;
TickTock 169:84d790ac18a2 591 } else if (dMode[whichTouched] == testScreen) { // gg -
TickTock 158:059abeb44ba1 592 clearTest=true;
TickTock 158:059abeb44ba1 593 } else { // top-right corner always mute/unmute unless used by specific screen
TickTock 154:90ea16ca7475 594 enableSound = !enableSound;
TickTock 155:f31006516956 595 if(!enableSound) spkr=0;
garygid 65:821fc79cd7fe 596 }
garygid 65:821fc79cd7fe 597
garygid 65:821fc79cd7fe 598 break;
garygid 54:6ce808d0995e 599 //----------------------------------
garygid 54:6ce808d0995e 600 //----------------------------------
garygid 67:2022fce701d0 601 case 01: // left col middle row
leafman 98:9f8bab96edff 602 if (dMode[whichTouched]==configScreen) {
TickTock 23:cd03f9c3395e 603 logEn = !logEn;
garygid 67:2022fce701d0 604 } else if (dMode[whichTouched] == indexScreen) { // gg - index
TickTock 73:62ee8eae3a84 605 dMode[whichTouched] = cpScreen ; // GoTo CP Data Screen
TickTock 73:62ee8eae3a84 606 sMode=0;
TickTock 42:4533b13b297d 607 } else if (dMode[whichTouched]==dateScreen){
TickTock 131:0d926c080a65 608 dtMode=(dtMode<5)?dtMode+1:0;
TickTock 42:4533b13b297d 609 lastDMode[whichTouched]=99;
TickTock 62:ffd15edb5431 610 } else {
TickTock 62:ffd15edb5431 611 lastDMode[whichTouched]=99;//repaint to clear highlight
TickTock 23:cd03f9c3395e 612 }
TickTock 62:ffd15edb5431 613
TickTock 23:cd03f9c3395e 614 break;
garygid 54:6ce808d0995e 615 //------------------------------
TickTock 23:cd03f9c3395e 616 case 11:
leafman 98:9f8bab96edff 617 if (dMode[whichTouched]==configScreen){
TickTock 77:7c136766466c 618 repeatPoll = !repeatPoll;
TickTock 33:a277743ebdeb 619 if (repeatPoll) {
TickTock 36:dbd39c315258 620 autoPoll.attach(&autoPollISR,pollInt);
TickTock 33:a277743ebdeb 621 } else {
TickTock 36:dbd39c315258 622 autoPoll.detach();
TickTock 33:a277743ebdeb 623 }
garygid 67:2022fce701d0 624 } else if (dMode[whichTouched] == indexScreen) { // gg - index
garygid 67:2022fce701d0 625 dMode[whichTouched] = cpHistScreen ; // GoTo CP Hist Screen
TickTock 73:62ee8eae3a84 626 sMode=0;
TickTock 42:4533b13b297d 627 } else if (dMode[whichTouched]==playbackScreen) {
TickTock 36:dbd39c315258 628 // Start/stop playback
TickTock 36:dbd39c315258 629 if(!playbackOpen){
TickTock 131:0d926c080a65 630 if(!carCanIdle){
TickTock 131:0d926c080a65 631 printMsg("Cannot playback while connected to canbus\n");
TickTock 131:0d926c080a65 632 }else if(!logOpen){
TickTock 109:3e6f0e8fca0d 633 efr = f_open(&efile,"playback.alc",FA_READ|FA_OPEN_EXISTING);
TickTock 50:83d5864c64a0 634 lastDMode[whichTouched]=99;//force refresh
TickTock 109:3e6f0e8fca0d 635 if(efr != FR_OK){
TickTock 116:5cd72bae7c12 636 printMsg("Unable to open /usb/playback.alc\n"); // no playback.alc
TickTock 155:f31006516956 637 beep(1000,0.25);
TickTock 36:dbd39c315258 638 } else {
TickTock 36:dbd39c315258 639 playbackOpen = true;
TickTock 50:83d5864c64a0 640 playbackEn=true;
TickTock 50:83d5864c64a0 641 playback.attach(&playbackISR,playbackInt);
TickTock 116:5cd72bae7c12 642 printMsg("Starting playback\n"); // start playback
TickTock 155:f31006516956 643 beep(2000,0.25);
TickTock 138:a2f5af85ed0d 644 can1.attach(NULL);// Stop recieving EVCAN data
TickTock 138:a2f5af85ed0d 645 can2.attach(NULL);// Stop recieving CARCAN data
TickTock 36:dbd39c315258 646 }
TickTock 36:dbd39c315258 647 } else {
TickTock 117:49883c779a74 648 printMsg("Must stop logging first\n");
TickTock 36:dbd39c315258 649 }
TickTock 36:dbd39c315258 650 } else {
TickTock 36:dbd39c315258 651 playback.detach();
TickTock 109:3e6f0e8fca0d 652 f_close(&efile);
TickTock 36:dbd39c315258 653 playbackOpen=false;
TickTock 50:83d5864c64a0 654 playbackEn=false;
TickTock 138:a2f5af85ed0d 655 can1.attach(&recieve1);// Restore EVCAN data recieve
TickTock 138:a2f5af85ed0d 656 can2.attach(&recieve2);// Restore EVCAN data recieve
TickTock 42:4533b13b297d 657 lastDMode[whichTouched]=99;
TickTock 36:dbd39c315258 658 }
TickTock 42:4533b13b297d 659 } else if (dMode[whichTouched]==dateScreen){
TickTock 25:ddf0ec209f03 660 upDate(dtMode,true);
TickTock 42:4533b13b297d 661 lastDMode[whichTouched]=99;
TickTock 62:ffd15edb5431 662 } else {
TickTock 62:ffd15edb5431 663 lastDMode[whichTouched]=99;//repaint to clear highlight
TickTock 25:ddf0ec209f03 664 }
TickTock 62:ffd15edb5431 665
TickTock 23:cd03f9c3395e 666 break;
garygid 54:6ce808d0995e 667 //---------------------------------
garygid 54:6ce808d0995e 668 case 21: // col 2 row 1
leafman 98:9f8bab96edff 669 if (dMode[whichTouched]==configScreen) { // gg - Batt Log Enable Button
TickTock 48:d1ce92104a1f 670 yesBattLog = !yesBattLog;
garygid 67:2022fce701d0 671 } else if (dMode[whichTouched] == indexScreen) { // gg - index
garygid 67:2022fce701d0 672 dMode[whichTouched] = cpBarScreen ; // GoTo CP Bars Screen
TickTock 73:62ee8eae3a84 673 sMode=0;
TickTock 48:d1ce92104a1f 674 } else if (dMode[whichTouched]==dateScreen){
TickTock 25:ddf0ec209f03 675 upDate(dtMode,false);
TickTock 42:4533b13b297d 676 lastDMode[whichTouched]=99;
TickTock 62:ffd15edb5431 677 } else {
TickTock 62:ffd15edb5431 678 lastDMode[whichTouched]=99;//repaint to clear highlight
TickTock 25:ddf0ec209f03 679 }
TickTock 62:ffd15edb5431 680
TickTock 23:cd03f9c3395e 681 break;
garygid 54:6ce808d0995e 682
garygid 87:46ac3f2519d6 683 case 31: // col 3 row 1
TickTock 157:1a100a5ed06f 684 if (dMode[whichTouched]==config2Screen) { // gg - Batt Log Enable Button
garygid 87:46ac3f2519d6 685 debugMode = !debugMode;
leafman 98:9f8bab96edff 686 } else if (dMode[whichTouched] == indexScreen) { // gg - index
TickTock 152:a4d66901785d 687 dMode[whichTouched] = configScreen ; // GoTo Config Screen
TickTock 177:6fda79c2fda1 688 } else if (dMode[whichTouched]==tripScreen) { // Cancel day trip meter
TickTock 177:6fda79c2fda1 689 ignoreDayData=true;
TickTock 177:6fda79c2fda1 690 lastDMode[whichTouched]=99;//repaint to clear highlight
TickTock 152:a4d66901785d 691 } else if ((dMode[whichTouched]==dateScreen)&&accOn){
TickTock 160:905fe45ed54b 692 syncDone=false; // initiate clock sync
TickTock 152:a4d66901785d 693 lastDMode[whichTouched]=99;
garygid 87:46ac3f2519d6 694 } else {
garygid 87:46ac3f2519d6 695 lastDMode[whichTouched]=99;//repaint to clear highlight
garygid 87:46ac3f2519d6 696 }
garygid 87:46ac3f2519d6 697 break;
garygid 87:46ac3f2519d6 698
garygid 54:6ce808d0995e 699 //-----------------------------------
garygid 67:2022fce701d0 700 case 02: // left col, bottom row (not nav)
garygid 67:2022fce701d0 701 if (dMode[whichTouched] == indexScreen) { // gg - index
leafman 98:9f8bab96edff 702 dMode[whichTouched] = playbackScreen ; // GoTo Playback Screen
leafman 98:9f8bab96edff 703 } else if (dMode[whichTouched]==configScreen) {
TickTock 140:ab3e94eb0227 704 brakeMon = !brakeMon;
TickTock 140:ab3e94eb0227 705 if(brakeMon){
TickTock 140:ab3e94eb0227 706 geiger.attach(&chirp,0.02);
TickTock 140:ab3e94eb0227 707 }else{
TickTock 140:ab3e94eb0227 708 geiger.detach();
TickTock 140:ab3e94eb0227 709 }
TickTock 158:059abeb44ba1 710 } else if (dMode[whichTouched]==config2Screen) {
TickTock 158:059abeb44ba1 711 autoSync = !autoSync;
garygid 87:46ac3f2519d6 712 } else {
garygid 87:46ac3f2519d6 713 lastDMode[whichTouched]=99;//repaint to clear highlight
garygid 87:46ac3f2519d6 714 }
garygid 67:2022fce701d0 715 break;
garygid 67:2022fce701d0 716
garygid 67:2022fce701d0 717 case 12: // left-middle col, bottom row (not nav)
TickTock 158:059abeb44ba1 718 if (dMode[whichTouched]==configScreen) {
TickTock 158:059abeb44ba1 719 regenMon = !regenMon;
TickTock 158:059abeb44ba1 720 } else if (dMode[whichTouched]==config2Screen) { // gg - index
leafman 98:9f8bab96edff 721 dMode[whichTouched] = dateScreen ; // GoTo Set Date/Time Screen
garygid 87:46ac3f2519d6 722 } else {
garygid 87:46ac3f2519d6 723 lastDMode[whichTouched]=99;//repaint to clear highlight
garygid 87:46ac3f2519d6 724 }
garygid 67:2022fce701d0 725 break;
garygid 67:2022fce701d0 726
garygid 67:2022fce701d0 727 case 22: // right-middle col, bottom row (not nav)
TickTock 158:059abeb44ba1 728 if (dMode[whichTouched]==indexScreen) { // gg - index
leafman 98:9f8bab96edff 729 dMode[whichTouched] = logScreen ;
TickTock 169:84d790ac18a2 730 sMode=0;
TickTock 159:577e9d015693 731 } else if (dMode[whichTouched]==configScreen) {
TickTock 159:577e9d015693 732 heaterMon = !heaterMon;
TickTock 157:1a100a5ed06f 733 } else if (dMode[whichTouched]==config2Screen) {
TickTock 169:84d790ac18a2 734 updateConfig();
TickTock 169:84d790ac18a2 735 lastDMode[whichTouched]=99;//force refresh
TickTock 169:84d790ac18a2 736 sMode=0;
garygid 87:46ac3f2519d6 737 } else {
garygid 87:46ac3f2519d6 738 lastDMode[whichTouched]=99;//repaint to clear highlight
garygid 87:46ac3f2519d6 739 }
garygid 67:2022fce701d0 740 break;
TickTock 72:f9a6faa28873 741
leafman 98:9f8bab96edff 742 case 32: // right col, bottom row (not nav)
TickTock 158:059abeb44ba1 743 if (dMode[whichTouched]==config2Screen) {
TickTock 114:3f8c59a8a2b9 744 logEn=false;
leafman 98:9f8bab96edff 745 updateFirmware();
TickTock 158:059abeb44ba1 746 } else if (dMode[whichTouched]==tripScreen) {
TickTock 177:6fda79c2fda1 747 // Reset custom trip meter
TickTock 108:29b5a760adc2 748 miles_trip[2]=0;
TickTock 108:29b5a760adc2 749 kWh_trip[2]=0;
TickTock 167:58d4edf403d4 750 CCkWh_trip[2]=0;
TickTock 73:62ee8eae3a84 751 sMode=0;
TickTock 108:29b5a760adc2 752 lastDMode[whichTouched]=99;//repaint to clear highlight
TickTock 158:059abeb44ba1 753 } else if (dMode[whichTouched]==indexScreen) {
TickTock 108:29b5a760adc2 754 dMode[whichTouched] = tripScreen ;
TickTock 169:84d790ac18a2 755 sMode=0;
TickTock 152:a4d66901785d 756 } else if (dMode[whichTouched]==dateScreen){
TickTock 152:a4d66901785d 757 autoSync=!autoSync; // toggle autoSync mode
TickTock 152:a4d66901785d 758 lastDMode[whichTouched]=99;
leafman 98:9f8bab96edff 759 } else {
garygid 87:46ac3f2519d6 760 lastDMode[whichTouched]=99;//repaint to clear highlight
TickTock 72:f9a6faa28873 761 }
TickTock 72:f9a6faa28873 762 break;
TickTock 72:f9a6faa28873 763
garygid 67:2022fce701d0 764 //-----------------------------------
garygid 54:6ce808d0995e 765 //-----------------------------------
garygid 54:6ce808d0995e 766 // Prev Navigation
garygid 54:6ce808d0995e 767 case 07: // col 0 row tNavRow
TickTock 42:4533b13b297d 768 dMode[whichTouched]=dMode[whichTouched]>0?dMode[whichTouched]-1:maxScreens;
TickTock 22:a43df3905863 769 break;
garygid 54:6ce808d0995e 770 //-----------------------------------
garygid 54:6ce808d0995e 771 // Select Screen Navigation
garygid 54:6ce808d0995e 772 case 17:
TickTock 43:e7f6f80590e3 773 sMode=0;
TickTock 43:e7f6f80590e3 774 lastDMode[whichTouched]=99; // Repaint
TickTock 22:a43df3905863 775 break;
garygid 54:6ce808d0995e 776 //-----------------------------------
garygid 54:6ce808d0995e 777 // Index Navigation
garygid 54:6ce808d0995e 778 case 27: // col 2 row tNavRow
garygid 67:2022fce701d0 779 dMode[whichTouched]= indexScreen ; // gg - index
garygid 54:6ce808d0995e 780 break;
garygid 54:6ce808d0995e 781 //------------------------------------
garygid 54:6ce808d0995e 782 // Next Navigation
garygid 54:6ce808d0995e 783 case 37: // lower right on Nav Line gg - move next
TickTock 42:4533b13b297d 784 dMode[whichTouched]=dMode[whichTouched]<maxScreens?dMode[whichTouched]+1:0;
TickTock 22:a43df3905863 785 break;
garygid 54:6ce808d0995e 786 //------------------------------------
garygid 54:6ce808d0995e 787 //------------------------------------
TickTock 22:a43df3905863 788 default:
TickTock 62:ffd15edb5431 789 lastDMode[whichTouched]=99;//repaint to clear highlight
TickTock 25:ddf0ec209f03 790 break;
TickTock 25:ddf0ec209f03 791 }
TickTock 23:cd03f9c3395e 792 break;
TickTock 23:cd03f9c3395e 793 case 2: // numpad
TickTock 23:cd03f9c3395e 794 break;
TickTock 23:cd03f9c3395e 795 case 3:
TickTock 23:cd03f9c3395e 796 break;
TickTock 23:cd03f9c3395e 797 default:
TickTock 23:cd03f9c3395e 798 break;
TickTock 23:cd03f9c3395e 799 } // case sMode
TickTock 22:a43df3905863 800 } //recently touched
TickTock 4:8d7759f4fe7a 801 } else { // userIdle
TickTock 8:67eed72f3e10 802 if(sMode==1){
TickTock 8:67eed72f3e10 803 sMode=0;
TickTock 43:e7f6f80590e3 804 lastDMode[whichTouched]=99;
TickTock 8:67eed72f3e10 805 }
TickTock 4:8d7759f4fe7a 806 }
TickTock 34:4751a8259b18 807
TickTock 153:e94cfe3c339c 808 // Sound tone on power reversal
TickTock 153:e94cfe3c339c 809 idir=(kW[0]>0)?true:false;
TickTock 155:f31006516956 810 if(regenMon){
TickTock 153:e94cfe3c339c 811 if (idir&&!lidir){
TickTock 155:f31006516956 812 beep(800,0.02); // Started sinking current
TickTock 153:e94cfe3c339c 813 }else if(!idir&&lidir){
TickTock 155:f31006516956 814 beep(3200,0.02); // Started regen
TickTock 153:e94cfe3c339c 815 }
TickTock 153:e94cfe3c339c 816 }
TickTock 154:90ea16ca7475 817 lidir=idir;
TickTock 153:e94cfe3c339c 818
TickTock 34:4751a8259b18 819 if(tick){ // Executes once a second
TickTock 108:29b5a760adc2 820 tick=false;
TickTock 164:46ed06263b0e 821 lCCon = CCon;
TickTock 161:71ac85d11f03 822 CCkW = (lastMsg[indexLastMsg[0x510]].data[3]&0x7f)*0.125;
TickTock 164:46ed06263b0e 823 if(lastMsg[indexLastMsg[0x510]].data[3]&0x80){
TickTock 164:46ed06263b0e 824 CCon=true; // On when button pushed
TickTock 164:46ed06263b0e 825 } else if(CCkW==0) {
TickTock 164:46ed06263b0e 826 CCon=false; // Off when power drops back to zero
TickTock 164:46ed06263b0e 827 }
TickTock 164:46ed06263b0e 828 if(!CCon && lCCon){
TickTock 164:46ed06263b0e 829 lastDMode[0]=99;//force refresh
TickTock 164:46ed06263b0e 830 lastDMode[1]=99;//force refresh
TickTock 164:46ed06263b0e 831 }
TickTock 93:c2402e8cd0e2 832 headlights = (lastMsg[indexLastMsg[0x358]].data[1]&0x80)?true:false; // headlight/turn signal indicator
TickTock 160:905fe45ed54b 833 if(heaterOn){
TickTock 160:905fe45ed54b 834 lHeaterOn=true; // Only indicate heater once per power cycle
TickTock 160:905fe45ed54b 835 }
TickTock 184:5ca7b78297fe 836 heaterOn =((lastMsg[indexLastMsg[0x54f]].data[5]&0x3f)>2)?true:false;
TickTock 159:577e9d015693 837 if(heaterMon && heaterOn && !lHeaterOn){ //Heat on alarm
TickTock 160:905fe45ed54b 838 beep3(800,0.25,1200,0.25,1600,0.25);
TickTock 160:905fe45ed54b 839 //beep(1600,0.5);
TickTock 159:577e9d015693 840 }
TickTock 148:6e3b9135fad2 841 if(accOn&&indexLastMsg[0x355]>0){
TickTock 141:cf13a632ddb5 842 miles_kmbar = (lastMsg[indexLastMsg[0x355]].data[4]&0x20)?true:false; // indicates selected distance units
TickTock 141:cf13a632ddb5 843 metric = !miles_kmbar;
TickTock 141:cf13a632ddb5 844 }
TickTock 41:8d4609ea7259 845 accV=floor(mon12V*scale12V*10+0.5)/10; //Round to nearest 10th
TickTock 172:53548bf8bf85 846 accOn=(playbackOpen||(accV>5))?true:false;
TickTock 131:0d926c080a65 847 moving=(mph[0]>0.1);
TickTock 151:3047ebb3c9a8 848 charging=(lastMsg[indexLastMsg[0x5bf]].data[2]>0)?true:false; // FF when charging
TickTock 134:ad243e4f1a17 849 if (laccOn&&!accOn){ // Car turned off
TickTock 177:6fda79c2fda1 850 dailyGids += startGids-((lastMsg[indexLastMsg[0x5bc]].data[0]<<2)+(lastMsg[indexLastMsg[0x5bc]].data[1]>>6));
TickTock 160:905fe45ed54b 851 lHeaterOn=false;
TickTock 172:53548bf8bf85 852 if (showHealth&&!playbackOpen){
TickTock 175:0357b4159b40 853 if (saveDmode[0]==99){
TickTock 175:0357b4159b40 854 saveDmode[0]=dMode[0];
TickTock 175:0357b4159b40 855 saveDmode[1]=dMode[1];
TickTock 134:ad243e4f1a17 856 }
TickTock 134:ad243e4f1a17 857 dMode[0]=healthScreen;
TickTock 175:0357b4159b40 858 dMode[1]=tripScreen;
TickTock 135:89986950d501 859 secsNoTouch=2;// Keep display on a few seconds
TickTock 134:ad243e4f1a17 860 sMode=0;
TickTock 134:ad243e4f1a17 861 userIdle=false;
TickTock 134:ad243e4f1a17 862 }
TickTock 108:29b5a760adc2 863 if (repeatPoll) { // Log on shutdown if autopoll enabled
TickTock 108:29b5a760adc2 864 tripLog(); // Write trip log on powerdown
TickTock 108:29b5a760adc2 865 }
TickTock 49:a3d2c5bb3cfa 866 //write efficiency history data
TickTock 97:a25940fd7b5b 867 hfile = fopen("/local/ehist.cny", "w");
TickTock 97:a25940fd7b5b 868 if (hfile!=NULL){ // found a efficiency history file
TickTock 49:a3d2c5bb3cfa 869 for(i=0;i<39;i++){
TickTock 97:a25940fd7b5b 870 fprintf(hfile,"%f %f\r\n",mph[i],kW[i]);
TickTock 49:a3d2c5bb3cfa 871 }
TickTock 134:ad243e4f1a17 872 fprintf(hfile,"%f %f\r\n",maxTripEff,minTripEff); // Save max and min
TickTock 155:f31006516956 873 fprintf(hfile,"%f \r\n",Resr); // Save series resistance
TickTock 167:58d4edf403d4 874 fprintf(hfile,"%f %f\r\n",maxTripMiles,minTripMiles); // Save max and min
TickTock 167:58d4edf403d4 875 fprintf(hfile,"%f %f\r\n",maxTripkWh,minTripkWh); // Save max and min
TickTock 167:58d4edf403d4 876 fprintf(hfile,"%f %f\r\n",maxTripCCkWh,minTripCCkWh); // Save max and min
TickTock 180:5fdeeb86f3a3 877 for(i=0;i<300;i++){
TickTock 180:5fdeeb86f3a3 878 fprintf(hfile,"%f\r\n",wh[i]);
TickTock 180:5fdeeb86f3a3 879 }
TickTock 97:a25940fd7b5b 880 fclose(hfile);
TickTock 49:a3d2c5bb3cfa 881 }
TickTock 49:a3d2c5bb3cfa 882 }
TickTock 134:ad243e4f1a17 883 if (!laccOn&&accOn){ // Car turned on
TickTock 160:905fe45ed54b 884 lHeaterOn=false;
TickTock 177:6fda79c2fda1 885 getGids=true;
TickTock 108:29b5a760adc2 886 miles_trip[0]=0;
TickTock 108:29b5a760adc2 887 kWh_trip[0]=0;
TickTock 167:58d4edf403d4 888 CCkWh_trip[0]=0;
TickTock 176:9c19f9856c76 889 seconds = time(NULL);
TickTock 176:9c19f9856c76 890 t = *localtime(&seconds);
TickTock 183:a1fba6f76e69 891 if(miles_trip[1]<1){ // charged since last trip
TickTock 184:5ca7b78297fe 892
TickTock 184:5ca7b78297fe 893 // Adjust wh lookup with whpg data
TickTock 180:5fdeeb86f3a3 894 maxWhpg=0;
TickTock 180:5fdeeb86f3a3 895 minWh=0;
TickTock 180:5fdeeb86f3a3 896 whOff=0;
TickTock 180:5fdeeb86f3a3 897 for(i=1;i<300;i++){
TickTock 184:5ca7b78297fe 898 if(whpg[i]>maxWhpg){ //Find maxWhpg and associated Wh
TickTock 184:5ca7b78297fe 899 maxWhpg = (float) whpg[i];
TickTock 184:5ca7b78297fe 900 minWh = wh[i];
TickTock 182:10017d74de67 901 if(debugMode){
TickTock 184:5ca7b78297fe 902 sprintf(sTemp,"maxWhpg=%3.1f; minWh=%3.1f\n", maxWhpg, minWh);
TickTock 184:5ca7b78297fe 903 printMsg(sTemp);
TickTock 182:10017d74de67 904 }
TickTock 180:5fdeeb86f3a3 905 }
TickTock 184:5ca7b78297fe 906 if(whpg[i]>0){ // Compute adjustment to measured range
TickTock 184:5ca7b78297fe 907 whOff = (maxWhpg-(float)whpg[i])-(wh[i]-minWh);
TickTock 184:5ca7b78297fe 908 }else if(whpg[i-1]>0){ // Compute final offset for rest of range
TickTock 184:5ca7b78297fe 909 whOff = maxWhpg-(wh[i]-minWh);
TickTock 184:5ca7b78297fe 910 if(debugMode){
TickTock 184:5ca7b78297fe 911 sprintf(sTemp,"whOff=%3.1f\n", whOff);
TickTock 184:5ca7b78297fe 912 printMsg(sTemp);
TickTock 180:5fdeeb86f3a3 913 }
TickTock 180:5fdeeb86f3a3 914 }
TickTock 184:5ca7b78297fe 915 wh[i] += 0.1*whOff; // Add offset; use last known good offset when no data
TickTock 184:5ca7b78297fe 916 whpg[i-1]=0;
TickTock 181:396fdcceefd2 917 }
TickTock 184:5ca7b78297fe 918 whpg[299]=0;
TickTock 184:5ca7b78297fe 919
TickTock 184:5ca7b78297fe 920 // Check and reset daily efficiency if charged since last trip and at least 24 hours has past
TickTock 183:a1fba6f76e69 921 if((t.tm_yday>lt.tm_yday)&&(t.tm_hour>effCheckTime)){
TickTock 183:a1fba6f76e69 922 if (!ignoreDayData&&(miles_trip[3]>15)){ // Ignore low mileage data
TickTock 183:a1fba6f76e69 923 curEff = miles_trip[3]/kWh_trip[3]; // Get current daily efficiency
TickTock 183:a1fba6f76e69 924 if (maxTripEff<curEff) {
TickTock 183:a1fba6f76e69 925 maxTripEff=curEff;
TickTock 183:a1fba6f76e69 926 maxTripMiles=miles_trip[3];
TickTock 183:a1fba6f76e69 927 maxTripkWh=kWh_trip[3];
TickTock 183:a1fba6f76e69 928 maxTripCCkWh=CCkWh_trip[3];
TickTock 183:a1fba6f76e69 929 printMsg("New max efficiency.\n");
TickTock 183:a1fba6f76e69 930 }
TickTock 183:a1fba6f76e69 931 if (minTripEff>curEff) {
TickTock 183:a1fba6f76e69 932 minTripEff=curEff;
TickTock 183:a1fba6f76e69 933 minTripMiles=miles_trip[3];
TickTock 183:a1fba6f76e69 934 minTripkWh=kWh_trip[3];
TickTock 183:a1fba6f76e69 935 minTripCCkWh=CCkWh_trip[3];
TickTock 183:a1fba6f76e69 936 printMsg("New min efficiency.\n");
TickTock 183:a1fba6f76e69 937 }
TickTock 183:a1fba6f76e69 938 }
TickTock 183:a1fba6f76e69 939 // Clear daily efficiency data
TickTock 183:a1fba6f76e69 940 dailyGids=0;
TickTock 183:a1fba6f76e69 941 miles_trip[3]=0;
TickTock 183:a1fba6f76e69 942 kWh_trip[3]=0;
TickTock 183:a1fba6f76e69 943 CCkWh_trip[3]=0;
TickTock 183:a1fba6f76e69 944 ignoreDayData=false;
TickTock 183:a1fba6f76e69 945 lt=t; // Remember when counters were cleared (start time for new data)
TickTock 183:a1fba6f76e69 946 }
TickTock 183:a1fba6f76e69 947 } // Charged since last trip
TickTock 115:549410af477d 948 wait5secs=5;
TickTock 172:53548bf8bf85 949 if (showHealth&&!playbackOpen){
TickTock 175:0357b4159b40 950 if (saveDmode[0]==99){
TickTock 175:0357b4159b40 951 saveDmode[0]=dMode[0];
TickTock 134:ad243e4f1a17 952 }
TickTock 131:0d926c080a65 953 dMode[0]=healthScreen;
TickTock 131:0d926c080a65 954 }
TickTock 152:a4d66901785d 955 syncDone=!autoSync; // clear syncDone flag if autoSync enabled
TickTock 177:6fda79c2fda1 956 } // Car turned on
TickTock 49:a3d2c5bb3cfa 957 laccOn=accOn;
TickTock 135:89986950d501 958 if(!accOn&&userIdle&&!playbackEn){ // Car off and no user activity - turn off screen
TickTock 134:ad243e4f1a17 959 dled = 0;
TickTock 175:0357b4159b40 960 if (saveDmode[0]<99){
TickTock 175:0357b4159b40 961 dMode[0]=saveDmode[0];
TickTock 175:0357b4159b40 962 saveDmode[0]=99;
TickTock 175:0357b4159b40 963 }
TickTock 175:0357b4159b40 964 if (saveDmode[1]<99){
TickTock 175:0357b4159b40 965 dMode[1]=saveDmode[1];
TickTock 175:0357b4159b40 966 saveDmode[1]=99;
TickTock 134:ad243e4f1a17 967 }
TickTock 35:5acbd8a64a89 968 }else if(!headlights){
TickTock 35:5acbd8a64a89 969 dled = ledHi;
TickTock 115:549410af477d 970 } else {
TickTock 35:5acbd8a64a89 971 dled = ledLo;
TickTock 34:4751a8259b18 972 }
TickTock 178:bf6404312c45 973 cgids=(lastMsg[indexLastMsg[0x5bc]].data[0]<<2)+(lastMsg[indexLastMsg[0x5bc]].data[1]>>6);
TickTock 172:53548bf8bf85 974 if(getGids){
TickTock 178:bf6404312c45 975 startGids=cgids; //Get gids
TickTock 177:6fda79c2fda1 976 if((startGids>0)&&(startGids<300)){ // Ignore bogus values at startup
TickTock 172:53548bf8bf85 977 getGids=false;
TickTock 178:bf6404312c45 978 lgids=startGids; // initialize wh/gid array
TickTock 172:53548bf8bf85 979 }
TickTock 172:53548bf8bf85 980 }
TickTock 179:e4094e55f079 981 if((cgids>0)&&(cgids<300)){
TickTock 183:a1fba6f76e69 982 if(cgids!=lgids){
TickTock 184:5ca7b78297fe 983 if((kWh_trip[1]+CCkWh_trip[1])>0){
TickTock 184:5ca7b78297fe 984 whpg[cgids] = (unsigned short) (1000*(kWh_trip[1]+CCkWh_trip[1])); // Save kWh for each gid since last charge
TickTock 184:5ca7b78297fe 985 }else{
TickTock 184:5ca7b78297fe 986 whpg[cgids] = 0;
TickTock 184:5ca7b78297fe 987 }
TickTock 179:e4094e55f079 988 lgids=cgids;
TickTock 179:e4094e55f079 989 }
TickTock 178:bf6404312c45 990 }
TickTock 115:549410af477d 991 if(wait5secs>0){ // Wait a few seconds after poweron to give BMS time to measure CP's
TickTock 115:549410af477d 992 wait5secs-=1;
TickTock 172:53548bf8bf85 993 if(wait5secs==0){
TickTock 172:53548bf8bf85 994 if (repeatPoll) { // Poll on startup if autopoll enabled
TickTock 172:53548bf8bf85 995 logOnce=true;
TickTock 172:53548bf8bf85 996 reqMsgCnt=0;
TickTock 172:53548bf8bf85 997 msgReq.attach(&sendReq,0.015);
TickTock 172:53548bf8bf85 998 lastDMode[0]=99;
TickTock 172:53548bf8bf85 999 lastDMode[1]=99;
TickTock 172:53548bf8bf85 1000 }
TickTock 108:29b5a760adc2 1001 }
TickTock 107:e9be732c1ad4 1002 }
TickTock 173:9815b1467039 1003 //remove health screen once moving
TickTock 175:0357b4159b40 1004 if(moving&&(saveDmode[0]<99)&&(wait5secs==0)){
TickTock 175:0357b4159b40 1005 dMode[0]=saveDmode[0];
TickTock 175:0357b4159b40 1006 saveDmode[0]=99;
TickTock 173:9815b1467039 1007 }
TickTock 115:549410af477d 1008
TickTock 49:a3d2c5bb3cfa 1009 //compute historic efficiency
TickTock 41:8d4609ea7259 1010 if(numSsamples>0){ // Avoid div0
TickTock 160:905fe45ed54b 1011 // calibrated to dash mph which reads slightly fast.
TickTock 160:905fe45ed54b 1012 // 227 would give more accurate mph for MXV4s@40psi - 11.75" distance from center of tire to pavement
TickTock 160:905fe45ed54b 1013 // but then efficiency estimation would not track miles driven as read from the odometer so
TickTock 160:905fe45ed54b 1014 // making CANary have the same error as the Leaf instrumentation
TickTock 174:cd27e80f197d 1015 mph[0]=((float) motorRPM)/numSsamples/110;
TickTock 86:d1c9e8ac1c4b 1016 } else {
TickTock 49:a3d2c5bb3cfa 1017 mph[0]=0;
TickTock 36:dbd39c315258 1018 }
TickTock 49:a3d2c5bb3cfa 1019 if(mph[0]>99){
TickTock 49:a3d2c5bb3cfa 1020 mph[0]=0;
TickTock 49:a3d2c5bb3cfa 1021 }
TickTock 121:553faf139a20 1022 numSsamples=0;
TickTock 107:e9be732c1ad4 1023
TickTock 41:8d4609ea7259 1024 if(numWsamples>0){ // Avoid div0
TickTock 121:553faf139a20 1025 mpkWh[0]=mph[0];
TickTock 161:71ac85d11f03 1026 kW[0]=((float) mWs_x4)/numWsamples/4e3;
TickTock 49:a3d2c5bb3cfa 1027 mpkWh[0]/=kW[0];
TickTock 49:a3d2c5bb3cfa 1028 if (mpkWh[0]<0) {
TickTock 49:a3d2c5bb3cfa 1029 mpkWh[0]=99;// negative means inf.
TickTock 49:a3d2c5bb3cfa 1030 }
TickTock 161:71ac85d11f03 1031 kW[0]-=CCkW; // subtract climate control power from recorded value
TickTock 161:71ac85d11f03 1032 } else {
TickTock 49:a3d2c5bb3cfa 1033 kW[0]=0;
TickTock 49:a3d2c5bb3cfa 1034 mpkWh[0]=0;
TickTock 49:a3d2c5bb3cfa 1035 }
TickTock 121:553faf139a20 1036 numWsamples=0;
TickTock 121:553faf139a20 1037
TickTock 172:53548bf8bf85 1038 if(accOn&&!charging){ // Calculate averages
TickTock 161:71ac85d11f03 1039 for(i=1;i<39;i++){
TickTock 161:71ac85d11f03 1040 average=mph[i]/timeConstant[i];
TickTock 161:71ac85d11f03 1041 mph[i]-=average;
TickTock 161:71ac85d11f03 1042 mph[i]+=mph[0];
TickTock 161:71ac85d11f03 1043 mpkWh[i]=average;
TickTock 161:71ac85d11f03 1044 average=kW[i]/timeConstant[i];
TickTock 161:71ac85d11f03 1045 kW[i]-=average;
TickTock 161:71ac85d11f03 1046 kW[i]+=kW[0];
TickTock 162:c6545fc0164a 1047 if(i==dtePeriod) mpkWh_noCC=mpkWh[i]/average; // compute efficiency w/o CC for dtePeriod
TickTock 161:71ac85d11f03 1048 average+=CCkW; //add climate control power back in for display
TickTock 161:71ac85d11f03 1049 mpkWh[i]/=average;
TickTock 161:71ac85d11f03 1050 if (mpkWh[i]<0) {
TickTock 161:71ac85d11f03 1051 mpkWh[i]=99;// negative means inf.
TickTock 161:71ac85d11f03 1052 }
TickTock 161:71ac85d11f03 1053 }
TickTock 161:71ac85d11f03 1054 }
TickTock 161:71ac85d11f03 1055
TickTock 121:553faf139a20 1056 if (!charging){
TickTock 151:3047ebb3c9a8 1057 miles_trip[0]+=mph[0]/3600; // per trip
TickTock 151:3047ebb3c9a8 1058 miles_trip[1]+=mph[0]/3600; // per charge
TickTock 151:3047ebb3c9a8 1059 miles_trip[2]+=mph[0]/3600; // user
TickTock 179:e4094e55f079 1060 miles_trip[3]+=mph[0]/3600; // per day/roundtrip
TickTock 121:553faf139a20 1061 kWh_trip[0]+=kW[0]/3600;
TickTock 121:553faf139a20 1062 kWh_trip[1]+=kW[0]/3600;
TickTock 121:553faf139a20 1063 kWh_trip[2]+=kW[0]/3600;
TickTock 176:9c19f9856c76 1064 kWh_trip[3]+=kW[0]/3600;
TickTock 167:58d4edf403d4 1065 CCkWh_trip[0]+=CCkW/3600;
TickTock 167:58d4edf403d4 1066 CCkWh_trip[1]+=CCkW/3600;
TickTock 167:58d4edf403d4 1067 CCkWh_trip[2]+=CCkW/3600;
TickTock 176:9c19f9856c76 1068 CCkWh_trip[3]+=CCkW/3600;
TickTock 161:71ac85d11f03 1069 } else { // charging so reset per charge trip meter
TickTock 151:3047ebb3c9a8 1070 miles_trip[1]=0;
TickTock 151:3047ebb3c9a8 1071 kWh_trip[1]=0;
TickTock 167:58d4edf403d4 1072 CCkWh_trip[1]=0;
TickTock 121:553faf139a20 1073 }
TickTock 121:553faf139a20 1074
TickTock 174:cd27e80f197d 1075 motorRPM=0;
TickTock 40:0e6e71a7323f 1076 mWs_x4=0;
TickTock 121:553faf139a20 1077
TickTock 121:553faf139a20 1078 // Compute ESR
TickTock 121:553faf139a20 1079 if((Imax-Imin)<40){ // do nothing - insufficient delta_I to measure
TickTock 121:553faf139a20 1080 unloadedV_x2 = (curRmax+curRmin)/2;
TickTock 154:90ea16ca7475 1081 }else if ((redRmax-redRmin)<(curRmax-curRmin)) { // less variation on reduced Resr
TickTock 120:041edeec08f5 1082 Resr-=0.001;
TickTock 120:041edeec08f5 1083 unloadedV_x2 = (redRmax+redRmin)/2;
TickTock 154:90ea16ca7475 1084 } else if ((incRmax-incRmin)<(curRmax-curRmin)) { // less variation on increased Resr
TickTock 120:041edeec08f5 1085 Resr+=0.001;
TickTock 120:041edeec08f5 1086 unloadedV_x2 = (incRmax+incRmin)/2;
TickTock 154:90ea16ca7475 1087 } else { // current Resr is still best answer
TickTock 120:041edeec08f5 1088 unloadedV_x2 = (curRmax+curRmin)/2;
TickTock 120:041edeec08f5 1089 }
TickTock 120:041edeec08f5 1090 curRmin=1000;
TickTock 120:041edeec08f5 1091 curRmax=0;
TickTock 120:041edeec08f5 1092 incRmin=1000;
TickTock 120:041edeec08f5 1093 incRmax=0;
TickTock 120:041edeec08f5 1094 redRmin=1000;
TickTock 120:041edeec08f5 1095 redRmax=0;
TickTock 121:553faf139a20 1096 Imax=-1000;
TickTock 121:553faf139a20 1097 Imin=1000;
TickTock 121:553faf139a20 1098
TickTock 108:29b5a760adc2 1099 if(logCP&&usbEn){
TickTock 108:29b5a760adc2 1100 if(logOnce){
TickTock 108:29b5a760adc2 1101 tripLog();
TickTock 108:29b5a760adc2 1102 logOnce=false;
TickTock 108:29b5a760adc2 1103 }
garygid 69:6bfdfc002036 1104 logPackVoltages(); // Turbo3, only call
TickTock 108:29b5a760adc2 1105 }
TickTock 137:70853cf5a30f 1106 if(!usbEn){
TickTock 108:29b5a760adc2 1107 usbEn=detectUSB(); // Keep looking if none found
TickTock 132:08748a67280a 1108 if(usbEn){ // Force update to clear USB init garbage
TickTock 132:08748a67280a 1109 lastDMode[0]=99;
TickTock 132:08748a67280a 1110 lastDMode[1]=99;
TickTock 132:08748a67280a 1111 }
TickTock 108:29b5a760adc2 1112 }
TickTock 152:a4d66901785d 1113 if(!syncDone){
TickTock 153:e94cfe3c339c 1114 syncDone=syncDateTime();
TickTock 152:a4d66901785d 1115 }
TickTock 121:553faf139a20 1116 tock=true;
TickTock 121:553faf139a20 1117 } // tick
TickTock 39:eef8beac7411 1118
TickTock 36:dbd39c315258 1119 if(step){ // playback
TickTock 36:dbd39c315258 1120 if(playbackOpen&&playbackEn){
TickTock 38:155ec32c5e91 1121 for(i=0;i<120;i++){
TickTock 109:3e6f0e8fca0d 1122 if(!f_eof(&efile)){
TickTock 109:3e6f0e8fca0d 1123 efr=f_read(&efile,&header,5,&bytesRW);
TickTock 109:3e6f0e8fca0d 1124 efr=f_read(&efile,&data,8,&bytesRW);
garygid 69:6bfdfc002036 1125 logCan(header[0],CANMessage(0x7ff&((header[4]<<8)+header[3]), data, 8)); // Playback
TickTock 86:d1c9e8ac1c4b 1126 } else {
TickTock 109:3e6f0e8fca0d 1127 f_close(&efile); // restart
TickTock 109:3e6f0e8fca0d 1128 efr = f_open(&efile,"playback.alc",FA_READ|FA_OPEN_EXISTING);
TickTock 50:83d5864c64a0 1129 lastDMode[whichTouched]=99;//force refresh
TickTock 155:f31006516956 1130 beep(2000,0.25);
TickTock 36:dbd39c315258 1131 }
TickTock 36:dbd39c315258 1132 }
TickTock 36:dbd39c315258 1133 }
TickTock 36:dbd39c315258 1134 step=false;
TickTock 36:dbd39c315258 1135 }
TickTock 37:fea2c1d52c5f 1136
TickTock 140:ab3e94eb0227 1137 display=display<1?display+1:0; // toggle display
TickTock 140:ab3e94eb0227 1138 updateDisplay(display);
TickTock 2:71b1999a8ea5 1139 } //while (true)
TickTock 0:1596b8644523 1140 }