Tick Tock / Mbed 2 deprecated CANary_9341_test

test fork

Dependencies:   SPI_TFTx2 SPI_TFTx2_ILI9341 TFT_fonts TOUCH_TFTx2 mbed

Fork of CANary_9341 by Tick Tock

main.cpp@161:71ac85d11f03, 2013-11-21 (annotated)

Committer:
TickTock
Date:
Thu Nov 21 14:17:35 2013 +0000
Revision:
161:71ac85d11f03
Parent:
160:905fe45ed54b
Child:
162:c6545fc0164a
// * Subtract climate control power from stored efficiency data and add current CC power back in for display; // * Added X axis labels on CP histogram and scaled bar width;

Who changed what in which revision?

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