Tick Tock / Mbed 2 deprecated CANary

Important changes to repositories hosted on mbed.com

Mbed hosted mercurial repositories are deprecated and are due to be permanently deleted in July 2026.

To keep a copy of this software download the repository Zip archive or clone locally using Mercurial.

It is also possible to export all your personal repositories from the account settings page.

Dependencies:   SPI_TFTx2_ILI9341 TFT_fonts TOUCH_TFTx2_ILI9341 mbed

Fork of CANary_corrupt by Tick Tock

main.cpp@202:4df5351a1e13, 2015-03-02 (annotated)

Committer:
TickTock
Date:
Mon Mar 02 20:29:21 2015 +0000
Revision:
202:4df5351a1e13
Parent:
201:4adbb1b56005
Child:
203:da9b422a6435
// * Move DTE to make room for more regen bubbles on dteDisplay.  Allow wrap.; // * Added full reset with extra (10s) long press

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