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