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@198:4e0decce14fd, 2014-08-20 (annotated)

Committer:
TickTock
Date:
Wed Aug 20 02:09:21 2014 +0000
Revision:
198:4e0decce14fd
Parent:
197:f566f65ff034
Child:
199:400b8950effa
// Fixed false long touch bug

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