Attempts to merge SPI_TFT2 & SPI_TFT_ILI9341
Dependencies: SPI_TFTx2 TFT_fonts TOUCH_TFTx2 mbed
Fork of CANary by
main.cpp@53:8a51361434ae, 2013-04-09 (annotated)
- Committer:
- TickTock
- Date:
- Tue Apr 09 12:46:07 2013 +0000
- Revision:
- 53:8a51361434ae
- Parent:
- 52:d5385fbf4ea1
- Child:
- 56:0de6b316c19b
Added playbackEn to accOn DTE computation qualifier so it can be tested with playback even if car is detected to be off (i.e. bench testing)
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
TickTock | 13:62e0f7f39ff5 | 1 | // main.cpp |
TickTock | 13:62e0f7f39ff5 | 2 | |
TickTock | 4:8d7759f4fe7a | 3 | //To Do: |
TickTock | 33:a277743ebdeb | 4 | // * USB device detect |
TickTock | 33:a277743ebdeb | 5 | // * Ability to update binary from the thumb-drive (requires file timestamp) |
TickTock | 33:a277743ebdeb | 6 | // * Audible friction brake feedback |
TickTock | 33:a277743ebdeb | 7 | // * User-configurable watchpoint |
TickTock | 33:a277743ebdeb | 8 | // * Better graphical DTE display with historic efficiency information considered and displayed |
TickTock | 33:a277743ebdeb | 9 | // * Add 50% charge option |
TickTock | 33:a277743ebdeb | 10 | // * Tire Pressure Sensor display |
TickTock | 13:62e0f7f39ff5 | 11 | |
TickTock | 12:8e42d7ba8468 | 12 | #include "mbed.h" |
TickTock | 12:8e42d7ba8468 | 13 | #include "CAN.h" |
TickTock | 12:8e42d7ba8468 | 14 | #include "beep.h" |
TickTock | 12:8e42d7ba8468 | 15 | #include "MSCFileSystem.h" |
TickTock | 12:8e42d7ba8468 | 16 | #include "PowerControl.h" |
TickTock | 12:8e42d7ba8468 | 17 | #include "EthernetPowerControl.h" |
TickTock | 12:8e42d7ba8468 | 18 | #include "utility.h" |
TickTock | 12:8e42d7ba8468 | 19 | #include "displayModes.h" |
TickTock | 23:cd03f9c3395e | 20 | #include "TOUCH_TFTx2.h" |
TickTock | 4:8d7759f4fe7a | 21 | |
TickTock | 13:62e0f7f39ff5 | 22 | LocalFileSystem local("local"); |
TickTock | 13:62e0f7f39ff5 | 23 | |
TickTock | 13:62e0f7f39ff5 | 24 | // to write to USB Flash Drives, or equivalent (SD card in Reader/Writer) |
TickTock | 35:5acbd8a64a89 | 25 | MSCFileSystem fs("usb"); // to write to a USB Flash Drive |
TickTock | 13:62e0f7f39ff5 | 26 | |
TickTock | 13:62e0f7f39ff5 | 27 | time_t seconds ; |
TickTock | 13:62e0f7f39ff5 | 28 | |
TickTock | 36:dbd39c315258 | 29 | Ticker autoPoll; |
TickTock | 36:dbd39c315258 | 30 | Ticker playback; |
TickTock | 13:62e0f7f39ff5 | 31 | Timer timer; |
TickTock | 13:62e0f7f39ff5 | 32 | |
TickTock | 13:62e0f7f39ff5 | 33 | DigitalOut led1(LED1); |
TickTock | 13:62e0f7f39ff5 | 34 | DigitalOut led2(LED2); |
TickTock | 13:62e0f7f39ff5 | 35 | DigitalOut led3(LED3); |
TickTock | 13:62e0f7f39ff5 | 36 | DigitalOut led4(LED4); |
TickTock | 13:62e0f7f39ff5 | 37 | |
TickTock | 13:62e0f7f39ff5 | 38 | InterruptIn touchpad(p17); |
TickTock | 13:62e0f7f39ff5 | 39 | CAN can1(p9, p10); // CAN1 (EV) uses pins 9 and 10 (rx, tx) and pin 8 (rs) |
TickTock | 13:62e0f7f39ff5 | 40 | DigitalOut can1SleepMode(p8); // Use pin 8 to control the sleep mode of can2 |
TickTock | 13:62e0f7f39ff5 | 41 | CAN can2(p30, p29); // CAN2 (CAR) uses pins 30 and 29 (rx, tx) and pin 28 (rs) |
TickTock | 13:62e0f7f39ff5 | 42 | DigitalOut can2SleepMode(p28); // Use pin 28 to control the sleep mode of can1 |
TickTock | 35:5acbd8a64a89 | 43 | AnalogIn mon12V(p15); |
TickTock | 13:62e0f7f39ff5 | 44 | 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 | 45 | PwmOut dled(p23); |
TickTock | 35:5acbd8a64a89 | 46 | Beep spkr(p21); |
TickTock | 13:62e0f7f39ff5 | 47 | |
TickTock | 48:d1ce92104a1f | 48 | bool logEn = false, logOpen = false; |
TickTock | 48:d1ce92104a1f | 49 | bool yesBattLog = false ; // gg - Batt Log |
TickTock | 15:a359fecf85ba | 50 | FILE *cfile; |
TickTock | 13:62e0f7f39ff5 | 51 | FILE *file; |
TickTock | 13:62e0f7f39ff5 | 52 | char fileName[35] = "" ; |
TickTock | 13:62e0f7f39ff5 | 53 | char writeBuffer[maxBufLen][13]; // buffer for USB write |
TickTock | 13:62e0f7f39ff5 | 54 | char indexLastMsg[0x800]={0}; // index table for last message |
TickTock | 13:62e0f7f39ff5 | 55 | CANMessage lastMsg[100]; // table to store last message of eachtype |
TickTock | 13:62e0f7f39ff5 | 56 | unsigned char battData[256]={0}; |
TickTock | 13:62e0f7f39ff5 | 57 | unsigned char msgChanged[100]; // inidcates which bytes changed |
TickTock | 13:62e0f7f39ff5 | 58 | char c; |
TickTock | 13:62e0f7f39ff5 | 59 | volatile int writePointer = 0; |
TickTock | 20:3bf176d14b14 | 60 | volatile int secsNoMsg = 0; |
TickTock | 20:3bf176d14b14 | 61 | volatile int secsNoTouch = 0; |
TickTock | 20:3bf176d14b14 | 62 | volatile bool canIdle; |
TickTock | 20:3bf176d14b14 | 63 | volatile bool userIdle; |
TickTock | 26:462ccb580472 | 64 | bool touched=false; //flag to read touchscreen |
TickTock | 42:4533b13b297d | 65 | unsigned char whichTouched = 0; |
TickTock | 13:62e0f7f39ff5 | 66 | char counter = 0; |
TickTock | 41:8d4609ea7259 | 67 | unsigned char dMode[2] = {mainScreen,brakeScreen}; //display mode |
TickTock | 13:62e0f7f39ff5 | 68 | unsigned char sMode = 0; // setup mode |
TickTock | 13:62e0f7f39ff5 | 69 | unsigned char lastDMode[2] = {0,0}; //last screen mode |
TickTock | 25:ddf0ec209f03 | 70 | unsigned char dtMode = 6; |
TickTock | 13:62e0f7f39ff5 | 71 | char displayLog[20][40]; |
TickTock | 13:62e0f7f39ff5 | 72 | unsigned char displayLoc = 0; |
TickTock | 13:62e0f7f39ff5 | 73 | unsigned char indexOffset = 1; |
TickTock | 13:62e0f7f39ff5 | 74 | bool showCP = false; |
TickTock | 33:a277743ebdeb | 75 | bool pollCP = false; |
TickTock | 39:eef8beac7411 | 76 | bool logCP = false; //Turbo3 |
TickTock | 33:a277743ebdeb | 77 | bool repeatPoll = false; |
TickTock | 34:4751a8259b18 | 78 | bool headlights = false; |
TickTock | 34:4751a8259b18 | 79 | bool tick = false; |
TickTock | 35:5acbd8a64a89 | 80 | float ledHi = 0.8; // Bright LED value (until config file read) |
TickTock | 35:5acbd8a64a89 | 81 | float ledLo = 0.1; // Dim LED value (until config file read) |
TickTock | 35:5acbd8a64a89 | 82 | unsigned short pollInt = 300; // polling interval=5 minutes (until config file read) |
TickTock | 35:5acbd8a64a89 | 83 | bool accOn = false; // Accessories on |
TickTock | 49:a3d2c5bb3cfa | 84 | bool laccOn = false; |
TickTock | 35:5acbd8a64a89 | 85 | float scale12V = 16.2; // R1:R2 ratio |
TickTock | 40:0e6e71a7323f | 86 | signed long mWs_x4 = 0; |
TickTock | 40:0e6e71a7323f | 87 | unsigned short numWsamples = 0; |
TickTock | 41:8d4609ea7259 | 88 | unsigned short numSsamples = 0; |
TickTock | 35:5acbd8a64a89 | 89 | float accV = 0; |
TickTock | 36:dbd39c315258 | 90 | bool playbackEn = false; |
TickTock | 36:dbd39c315258 | 91 | bool playbackOpen = false; |
TickTock | 49:a3d2c5bb3cfa | 92 | //float playbackInt = 0.05; //read messages every 50 ms |
TickTock | 49:a3d2c5bb3cfa | 93 | float playbackInt = 0.005; //read messages every 50 ms |
TickTock | 36:dbd39c315258 | 94 | bool step = false; |
TickTock | 37:fea2c1d52c5f | 95 | char header[5]; |
TickTock | 36:dbd39c315258 | 96 | char data[8]; |
TickTock | 41:8d4609ea7259 | 97 | signed long motorRPM; |
TickTock | 48:d1ce92104a1f | 98 | unsigned char skin = 0; |
TickTock | 50:83d5864c64a0 | 99 | unsigned char dtePeriod = 14; //ten minute averaging interval |
TickTock | 49:a3d2c5bb3cfa | 100 | float mph[39]={0}; |
TickTock | 49:a3d2c5bb3cfa | 101 | float kW[39]={0}; |
TickTock | 49:a3d2c5bb3cfa | 102 | float mpkWh[39]={0}; |
TickTock | 49:a3d2c5bb3cfa | 103 | // Logarithmic division scale (roughly - snapped to common units of time) |
TickTock | 49:a3d2c5bb3cfa | 104 | 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 | 105 | 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 | 106 | 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 | 107 | 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 | 108 | 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 | 49:a3d2c5bb3cfa | 109 | bool updateDTE = false; |
TickTock | 13:62e0f7f39ff5 | 110 | |
TickTock | 0:1596b8644523 | 111 | int main() { |
TickTock | 2:71b1999a8ea5 | 112 | int readPointer=0; |
TickTock | 4:8d7759f4fe7a | 113 | char sTemp[40]; |
TickTock | 2:71b1999a8ea5 | 114 | unsigned long secs; |
TickTock | 49:a3d2c5bb3cfa | 115 | unsigned char i,j,display=0,lwt=0; |
TickTock | 22:a43df3905863 | 116 | point lastTouch; |
TickTock | 52:d5385fbf4ea1 | 117 | float average; |
TickTock | 7:17bf9ceaf0aa | 118 | |
TickTock | 8:67eed72f3e10 | 119 | can1.monitor(true); // set to snoop mode |
TickTock | 8:67eed72f3e10 | 120 | can2.monitor(true); // set to snoop mode |
TickTock | 2:71b1999a8ea5 | 121 | can1.frequency(500000); |
TickTock | 2:71b1999a8ea5 | 122 | can2.frequency(500000); |
TickTock | 7:17bf9ceaf0aa | 123 | can1SleepMode = 1; // Turn on Monitor_only Mode |
TickTock | 7:17bf9ceaf0aa | 124 | can2SleepMode = 1; // Turn on Monitor_only Mode |
TickTock | 0:1596b8644523 | 125 | can1.attach(&recieve1); |
TickTock | 0:1596b8644523 | 126 | can2.attach(&recieve2); |
TickTock | 4:8d7759f4fe7a | 127 | |
TickTock | 3:3e879b043bc5 | 128 | tt.set_orientation(1); |
TickTock | 4:8d7759f4fe7a | 129 | tt.background(Black); |
TickTock | 19:d576298c46f3 | 130 | tt.set_display(2); // select both displays |
TickTock | 3:3e879b043bc5 | 131 | tt.cls(); |
TickTock | 1:9dcd70c32180 | 132 | tt.claim(stdout); // send stdout to the TFT display |
TickTock | 12:8e42d7ba8468 | 133 | touchpad.rise(&touch_ISR); |
TickTock | 4:8d7759f4fe7a | 134 | tt.wfi(); // enable interrupt on touch |
TickTock | 7:17bf9ceaf0aa | 135 | dled = 0.8; // turn on display LED 80% |
TickTock | 26:462ccb580472 | 136 | |
TickTock | 2:71b1999a8ea5 | 137 | timer.start() ; |
TickTock | 2:71b1999a8ea5 | 138 | RTC_Init(); // start the RTC Interrupts that sync the timer |
TickTock | 1:9dcd70c32180 | 139 | struct tm t; // pointer to a static tm structure |
TickTock | 19:d576298c46f3 | 140 | NVIC_SetPriority(TIMER3_IRQn, 1); //set ticker priority |
TickTock | 19:d576298c46f3 | 141 | NVIC_SetPriority(CAN_IRQn, 2); //higher than can (so RTC sync works) |
TickTock | 33:a277743ebdeb | 142 | |
TickTock | 1:9dcd70c32180 | 143 | seconds = time(NULL); |
TickTock | 1:9dcd70c32180 | 144 | t = *localtime(&seconds) ; |
TickTock | 1:9dcd70c32180 | 145 | // is it a date before 2012 ? |
TickTock | 26:462ccb580472 | 146 | if ((t.tm_year + 1900) < 2012 ) { |
TickTock | 26:462ccb580472 | 147 | // before 2013 so update year to make date entry easier |
TickTock | 26:462ccb580472 | 148 | t.tm_year = 2013 - 1900; |
TickTock | 1:9dcd70c32180 | 149 | // set the RTC |
TickTock | 1:9dcd70c32180 | 150 | set_time(mktime(&t)); |
TickTock | 1:9dcd70c32180 | 151 | seconds = time(NULL); |
TickTock | 26:462ccb580472 | 152 | } |
TickTock | 20:3bf176d14b14 | 153 | t = *localtime(&seconds) ; |
TickTock | 20:3bf176d14b14 | 154 | strftime(sTemp, 32, "%a %m/%d/%Y %X\n", &t); |
TickTock | 20:3bf176d14b14 | 155 | logMsg(sTemp); |
TickTock | 52:d5385fbf4ea1 | 156 | sprintf(sTemp,"CANary firmware rev52\n"); |
TickTock | 43:e7f6f80590e3 | 157 | logMsg(sTemp); |
TickTock | 15:a359fecf85ba | 158 | |
TickTock | 26:462ccb580472 | 159 | // Look for new binary on thumbdrive |
TickTock | 17:e32324a2678d | 160 | // Can't make this work right now since USB doesn't attach the right timestamp (so new binary isn't loaded) |
TickTock | 35:5acbd8a64a89 | 161 | /*cfile = fopen("/usb/CANary.bin", "rb"); |
TickTock | 50:83d5864c64a0 | 162 | lastDMode[whichTouched]=99;//force refresh |
TickTock | 17:e32324a2678d | 163 | if (cfile!=NULL){ //found a new binary on the thumbdrive so copy it over |
TickTock | 17:e32324a2678d | 164 | sprintf(sTemp,"New binary found.\n"); |
TickTock | 17:e32324a2678d | 165 | logMsg(sTemp); |
TickTock | 17:e32324a2678d | 166 | file = fopen("/local/CANary.bin", "wb"); |
TickTock | 17:e32324a2678d | 167 | if (file==NULL){ //failed to open destination |
TickTock | 17:e32324a2678d | 168 | sprintf(sTemp,"Unable to open destination file.\n"); |
TickTock | 17:e32324a2678d | 169 | logMsg(sTemp); |
TickTock | 17:e32324a2678d | 170 | } else { |
TickTock | 18:999401f359a5 | 171 | tt.set_display(2); |
TickTock | 18:999401f359a5 | 172 | tt.foreground(White); |
TickTock | 18:999401f359a5 | 173 | tt.background(Black); |
TickTock | 18:999401f359a5 | 174 | tt.cls(); |
TickTock | 18:999401f359a5 | 175 | tt.locate(1,40); |
TickTock | 18:999401f359a5 | 176 | printf("%s\n","Copying binary - Do no remove power."); |
TickTock | 18:999401f359a5 | 177 | tt.locate(1,80); |
TickTock | 18:999401f359a5 | 178 | printf("CANary will reset when complete.\n"); |
TickTock | 18:999401f359a5 | 179 | wait(1); //Wait 1 sec for display DMA to finish before writing file |
TickTock | 17:e32324a2678d | 180 | while ( int size = fread( writeBuffer, sizeof(char), maxBufLen*13, cfile )){ |
TickTock | 17:e32324a2678d | 181 | fwrite( writeBuffer, sizeof(char), size, file ); |
TickTock | 18:999401f359a5 | 182 | led4=led3; |
TickTock | 18:999401f359a5 | 183 | led3=led2; |
TickTock | 18:999401f359a5 | 184 | led2=led1; |
TickTock | 18:999401f359a5 | 185 | led1=!led4; |
TickTock | 17:e32324a2678d | 186 | } |
TickTock | 17:e32324a2678d | 187 | fclose(cfile); |
TickTock | 17:e32324a2678d | 188 | fclose(file); |
TickTock | 35:5acbd8a64a89 | 189 | remove("/usb/CANary.bin"); // delete original |
TickTock | 17:e32324a2678d | 190 | mbed_reset(); //restart |
TickTock | 17:e32324a2678d | 191 | } |
TickTock | 18:999401f359a5 | 192 | }*/ |
TickTock | 17:e32324a2678d | 193 | |
TickTock | 26:462ccb580472 | 194 | secsNoMsg = 0; |
TickTock | 43:e7f6f80590e3 | 195 | |
TickTock | 49:a3d2c5bb3cfa | 196 | //read efficiency history data |
TickTock | 49:a3d2c5bb3cfa | 197 | cfile = fopen("/local/ehist.cny", "r"); |
TickTock | 49:a3d2c5bb3cfa | 198 | if (cfile!=NULL){ // found a efficiency history file |
TickTock | 49:a3d2c5bb3cfa | 199 | for(i=0;i<39;i++){ |
TickTock | 49:a3d2c5bb3cfa | 200 | if(!feof(cfile)){ |
TickTock | 49:a3d2c5bb3cfa | 201 | fscanf(cfile,"%f %f\r\n",&mph[i],&kW[i]); |
TickTock | 49:a3d2c5bb3cfa | 202 | mpkWh[i]=mph[i]/kW[i]; |
TickTock | 49:a3d2c5bb3cfa | 203 | } |
TickTock | 49:a3d2c5bb3cfa | 204 | } |
TickTock | 49:a3d2c5bb3cfa | 205 | fclose(cfile); |
TickTock | 49:a3d2c5bb3cfa | 206 | sprintf(sTemp,"History Loaded.\n"); |
TickTock | 49:a3d2c5bb3cfa | 207 | logMsg(sTemp); |
TickTock | 49:a3d2c5bb3cfa | 208 | } else { // create initial file |
TickTock | 49:a3d2c5bb3cfa | 209 | sprintf(sTemp,"History not found. Created.\n"); |
TickTock | 49:a3d2c5bb3cfa | 210 | logMsg(sTemp); |
TickTock | 49:a3d2c5bb3cfa | 211 | for(i=0;i<39;i++){ |
TickTock | 49:a3d2c5bb3cfa | 212 | // Pre-load with 4 mpkWh @ 40 mph |
TickTock | 49:a3d2c5bb3cfa | 213 | mph[i]=40*timeConstant[i]; |
TickTock | 49:a3d2c5bb3cfa | 214 | kW[i]=10*timeConstant[i]; |
TickTock | 49:a3d2c5bb3cfa | 215 | mpkWh[i]=4; |
TickTock | 49:a3d2c5bb3cfa | 216 | } |
TickTock | 49:a3d2c5bb3cfa | 217 | } |
TickTock | 49:a3d2c5bb3cfa | 218 | |
TickTock | 46:73e8716f976f | 219 | // Read config file |
TickTock | 46:73e8716f976f | 220 | readConfig(); |
TickTock | 43:e7f6f80590e3 | 221 | |
TickTock | 26:462ccb580472 | 222 | touched=false; |
TickTock | 26:462ccb580472 | 223 | secsNoTouch=2; |
TickTock | 2:71b1999a8ea5 | 224 | while (true) { |
TickTock | 4:8d7759f4fe7a | 225 | if (!logOpen) { // Open new file if one is not already open |
TickTock | 7:17bf9ceaf0aa | 226 | if(logEn){ //logging enable |
TickTock | 7:17bf9ceaf0aa | 227 | seconds = time(NULL); |
TickTock | 7:17bf9ceaf0aa | 228 | t = *localtime(&seconds) ; |
TickTock | 35:5acbd8a64a89 | 229 | strftime(fileName, 32, "/usb/%m%d%H%M.alc", &t); //mmddhhmm.alc |
TickTock | 16:2a6ca248e1cb | 230 | //sprintf(sTemp,"Using file %s\n",fileName); |
TickTock | 16:2a6ca248e1cb | 231 | //logMsg(sTemp); |
TickTock | 7:17bf9ceaf0aa | 232 | file = fopen(fileName, "ab"); |
TickTock | 50:83d5864c64a0 | 233 | lastDMode[whichTouched]=99;//force refresh |
TickTock | 7:17bf9ceaf0aa | 234 | if(file==NULL){ |
TickTock | 7:17bf9ceaf0aa | 235 | sprintf(sTemp,"\nUnable to open %s\n\n\n\n",fileName); |
TickTock | 7:17bf9ceaf0aa | 236 | logMsg(sTemp); |
TickTock | 7:17bf9ceaf0aa | 237 | logEn=false; |
TickTock | 26:462ccb580472 | 238 | spkr.beep(1000,0.25); |
TickTock | 7:17bf9ceaf0aa | 239 | } else { |
TickTock | 7:17bf9ceaf0aa | 240 | logOpen = true; |
TickTock | 7:17bf9ceaf0aa | 241 | readPointer=writePointer; |
TickTock | 7:17bf9ceaf0aa | 242 | sprintf(sTemp,"Starting Can Log %s\n",fileName); |
TickTock | 7:17bf9ceaf0aa | 243 | logMsg(sTemp); |
TickTock | 7:17bf9ceaf0aa | 244 | logTS(); |
TickTock | 26:462ccb580472 | 245 | spkr.beep(2000,0.25); |
TickTock | 7:17bf9ceaf0aa | 246 | } |
TickTock | 7:17bf9ceaf0aa | 247 | }//logging enabled |
TickTock | 15:a359fecf85ba | 248 | } else { // if (logOpen) |
TickTock | 30:e633a63eb257 | 249 | if (((writePointer+maxBufLen-readPointer)%maxBufLen)>(maxBufLen/16)||canIdle||!logEn) { |
TickTock | 7:17bf9ceaf0aa | 250 | // Dump buffer if > 1/16 full or canbus has stopped |
TickTock | 7:17bf9ceaf0aa | 251 | if (file == NULL) { |
TickTock | 7:17bf9ceaf0aa | 252 | logOpen = false; |
TickTock | 37:fea2c1d52c5f | 253 | sprintf(sTemp,"Failed to append log file.\n"); |
TickTock | 37:fea2c1d52c5f | 254 | logMsg(sTemp); |
TickTock | 26:462ccb580472 | 255 | spkr.beep(1000,0.25); |
TickTock | 7:17bf9ceaf0aa | 256 | logEn=false; |
TickTock | 7:17bf9ceaf0aa | 257 | } else { |
TickTock | 37:fea2c1d52c5f | 258 | if (((writePointer+maxBufLen-readPointer)%maxBufLen)>(maxBufLen*7/8)) { // Hi-water mark |
TickTock | 37:fea2c1d52c5f | 259 | sprintf(sTemp,"Write buffer overrun.\n"); |
TickTock | 37:fea2c1d52c5f | 260 | logMsg(sTemp); |
TickTock | 37:fea2c1d52c5f | 261 | spkr.beep(1000,0.25); |
TickTock | 37:fea2c1d52c5f | 262 | } |
TickTock | 7:17bf9ceaf0aa | 263 | while (readPointer != writePointer) { |
TickTock | 7:17bf9ceaf0aa | 264 | for (j = 0; j<13; j++){ |
TickTock | 7:17bf9ceaf0aa | 265 | fprintf(file,"%c",writeBuffer[readPointer][j]); |
TickTock | 4:8d7759f4fe7a | 266 | } |
TickTock | 7:17bf9ceaf0aa | 267 | if(++readPointer >= maxBufLen) |
TickTock | 7:17bf9ceaf0aa | 268 | readPointer=0; |
TickTock | 4:8d7759f4fe7a | 269 | } |
TickTock | 7:17bf9ceaf0aa | 270 | led4 = !led4; |
TickTock | 7:17bf9ceaf0aa | 271 | } |
TickTock | 30:e633a63eb257 | 272 | } // if > 1/16 full, canbus has stopped, or logging stopped |
TickTock | 30:e633a63eb257 | 273 | if (!logEn) { |
TickTock | 30:e633a63eb257 | 274 | fclose(file); |
TickTock | 30:e633a63eb257 | 275 | logOpen=false; |
TickTock | 30:e633a63eb257 | 276 | } |
TickTock | 4:8d7759f4fe7a | 277 | } // if logOpen |
TickTock | 36:dbd39c315258 | 278 | if (canIdle&&userIdle&&!playbackEn) { // canbus idle --> sleep to save power |
TickTock | 26:462ccb580472 | 279 | if (logOpen){ |
TickTock | 7:17bf9ceaf0aa | 280 | fclose(file); |
TickTock | 7:17bf9ceaf0aa | 281 | } // if (logOpen)*/ |
TickTock | 20:3bf176d14b14 | 282 | seconds = time(NULL); |
TickTock | 20:3bf176d14b14 | 283 | t = *localtime(&seconds) ; |
TickTock | 21:22bdce9efcb5 | 284 | strftime(sTemp, 40, "Sleeping: %a %m/%d/%Y %X\n", &t); |
TickTock | 4:8d7759f4fe7a | 285 | logMsg(sTemp); |
TickTock | 25:ddf0ec209f03 | 286 | updateDisplay(0); //Added for turbo3 who has a display override and wants to see the sleep message before going to sleep |
TickTock | 25:ddf0ec209f03 | 287 | updateDisplay(1); |
TickTock | 4:8d7759f4fe7a | 288 | //LPC_RTC->CIIR=0x00; // block RTC interrupts |
TickTock | 4:8d7759f4fe7a | 289 | led1=0; |
TickTock | 4:8d7759f4fe7a | 290 | led2=0; |
TickTock | 4:8d7759f4fe7a | 291 | led3=0; |
TickTock | 4:8d7759f4fe7a | 292 | led4=0; |
TickTock | 4:8d7759f4fe7a | 293 | dled=0; // turn off display |
TickTock | 4:8d7759f4fe7a | 294 | secs = time(NULL); // seconds past 12:00:00 AM 1 Jan 1900 |
TickTock | 22:a43df3905863 | 295 | while (secsNoMsg>canTimeout && !touched) { |
TickTock | 4:8d7759f4fe7a | 296 | //DeepPowerDown(); |
TickTock | 12:8e42d7ba8468 | 297 | tt.wfi(); //enable touch interrupt |
TickTock | 21:22bdce9efcb5 | 298 | //__wfi(); // freeze CPU and wait for interrupt (from canbus or touch) |
TickTock | 21:22bdce9efcb5 | 299 | Sleep(); |
TickTock | 4:8d7759f4fe7a | 300 | } |
TickTock | 43:e7f6f80590e3 | 301 | secsNoTouch=2; |
TickTock | 4:8d7759f4fe7a | 302 | canIdle=secsNoMsg>canTimeout; |
TickTock | 43:e7f6f80590e3 | 303 | //userIdle=!touched; |
TickTock | 7:17bf9ceaf0aa | 304 | dled=0.8; // turn on display LED |
TickTock | 20:3bf176d14b14 | 305 | seconds = time(NULL); |
TickTock | 20:3bf176d14b14 | 306 | t = *localtime(&seconds) ; |
TickTock | 21:22bdce9efcb5 | 307 | strftime(sTemp, 40, "Waking: %a %m/%d/%Y %X\n", &t); |
TickTock | 4:8d7759f4fe7a | 308 | logMsg(sTemp); |
TickTock | 4:8d7759f4fe7a | 309 | if (time(NULL)>(secs+1800)) { |
TickTock | 4:8d7759f4fe7a | 310 | logOpen = false; // Start new file if asleep for more than 30 minutes |
TickTock | 4:8d7759f4fe7a | 311 | if (secsNoTouch>100) secsNoTouch = 100; // also mostly reset user Idle counter |
TickTock | 43:e7f6f80590e3 | 312 | } else if (logOpen){ // insert timestamp on each wake if logging enabled (disabled for now) |
TickTock | 7:17bf9ceaf0aa | 313 | file = fopen(fileName, "ab"); |
TickTock | 4:8d7759f4fe7a | 314 | logTS(); |
TickTock | 4:8d7759f4fe7a | 315 | } |
TickTock | 4:8d7759f4fe7a | 316 | } // if idle |
TickTock | 4:8d7759f4fe7a | 317 | |
TickTock | 15:a359fecf85ba | 318 | if(touched){ // call touchscreen procedure if touch interrupt detected |
TickTock | 7:17bf9ceaf0aa | 319 | lastTouch = tt.get_touch(); |
TickTock | 7:17bf9ceaf0aa | 320 | lastTouch = tt.to_pixel(lastTouch); // convert to pixel pos |
TickTock | 40:0e6e71a7323f | 321 | if((lastTouch.x!=639)&&(lastTouch.x!=319)&&(lastTouch.y!=239)){ // filter phantom touches |
TickTock | 43:e7f6f80590e3 | 322 | if (userIdle) { |
TickTock | 43:e7f6f80590e3 | 323 | secsNoTouch=2; // Ignore first touch if user idle |
TickTock | 43:e7f6f80590e3 | 324 | userIdle=false; |
TickTock | 40:0e6e71a7323f | 325 | } else { |
TickTock | 43:e7f6f80590e3 | 326 | secsNoTouch=0; |
TickTock | 40:0e6e71a7323f | 327 | } |
TickTock | 43:e7f6f80590e3 | 328 | if (lastTouch.x>320){ |
TickTock | 43:e7f6f80590e3 | 329 | whichTouched=1; |
TickTock | 43:e7f6f80590e3 | 330 | } else { |
TickTock | 43:e7f6f80590e3 | 331 | whichTouched=0; |
TickTock | 43:e7f6f80590e3 | 332 | } |
TickTock | 43:e7f6f80590e3 | 333 | if (whichTouched!=lwt){ |
TickTock | 43:e7f6f80590e3 | 334 | lastDMode[lwt]=99; // Repaint lastTouched |
TickTock | 43:e7f6f80590e3 | 335 | lwt=whichTouched; |
TickTock | 43:e7f6f80590e3 | 336 | } |
TickTock | 43:e7f6f80590e3 | 337 | sMode = 1; |
TickTock | 22:a43df3905863 | 338 | } |
TickTock | 22:a43df3905863 | 339 | //sprintf(sTemp,"%d,%d ",lastTouch.x,lastTouch.y); |
TickTock | 22:a43df3905863 | 340 | //logMsg(sTemp); |
TickTock | 12:8e42d7ba8468 | 341 | touched = false; // clear interrupt flag |
TickTock | 7:17bf9ceaf0aa | 342 | } |
TickTock | 4:8d7759f4fe7a | 343 | if (!userIdle) { |
TickTock | 4:8d7759f4fe7a | 344 | if (secsNoTouch<2) {// Recently touched |
TickTock | 4:8d7759f4fe7a | 345 | secsNoTouch +=2; // increment to prevent double touch |
TickTock | 43:e7f6f80590e3 | 346 | sMode = 1; |
TickTock | 22:a43df3905863 | 347 | //sprintf(sTemp,"button %d %d,%d %d\n",i,buttonX(lastTouch.x,3),buttonY(lastTouch.y,3),lastTouch.x); |
TickTock | 22:a43df3905863 | 348 | //logMsg(sTemp); |
TickTock | 23:cd03f9c3395e | 349 | switch (sMode) { |
TickTock | 23:cd03f9c3395e | 350 | case 0: // no select |
TickTock | 23:cd03f9c3395e | 351 | break; |
TickTock | 23:cd03f9c3395e | 352 | case 1: // select screen |
TickTock | 23:cd03f9c3395e | 353 | switch (buttonX(lastTouch.x,3)*10+buttonY(lastTouch.y,3)) { |
TickTock | 23:cd03f9c3395e | 354 | case 00: |
TickTock | 23:cd03f9c3395e | 355 | case 30: |
TickTock | 42:4533b13b297d | 356 | if (dMode[whichTouched]==monitorScreen||dMode[whichTouched]==changedScreen) { |
TickTock | 23:cd03f9c3395e | 357 | indexOffset=indexOffset>4?indexOffset-4:1; |
TickTock | 42:4533b13b297d | 358 | } else if (dMode[whichTouched]==config1Screen) { |
TickTock | 23:cd03f9c3395e | 359 | wait_ms(500); |
TickTock | 37:fea2c1d52c5f | 360 | tt.background(Black); |
TickTock | 23:cd03f9c3395e | 361 | tt.calibrate(); |
TickTock | 42:4533b13b297d | 362 | } else if (dMode[whichTouched]==playbackScreen) { // slower |
TickTock | 36:dbd39c315258 | 363 | playbackInt *=2; |
TickTock | 36:dbd39c315258 | 364 | if(playbackEn){ |
TickTock | 36:dbd39c315258 | 365 | playback.detach(); |
TickTock | 36:dbd39c315258 | 366 | playback.attach(&playbackISR,playbackInt); |
TickTock | 36:dbd39c315258 | 367 | } |
TickTock | 23:cd03f9c3395e | 368 | } |
TickTock | 23:cd03f9c3395e | 369 | break; |
TickTock | 23:cd03f9c3395e | 370 | case 10: |
TickTock | 48:d1ce92104a1f | 371 | case 40: |
TickTock | 42:4533b13b297d | 372 | if (dMode[whichTouched]==changedScreen) { |
TickTock | 23:cd03f9c3395e | 373 | for(j=0;j<100;j++) msgChanged[j]=0; // clear changed data |
TickTock | 42:4533b13b297d | 374 | lastDMode[whichTouched]=99;//force refresh |
TickTock | 42:4533b13b297d | 375 | } else if (dMode[whichTouched]==cpScreen) { |
TickTock | 33:a277743ebdeb | 376 | pollCP=true; |
TickTock | 48:d1ce92104a1f | 377 | } else if (dMode[whichTouched]==cpHistScreen) { // gg - hist |
TickTock | 48:d1ce92104a1f | 378 | pollCP=true; |
TickTock | 48:d1ce92104a1f | 379 | } else if (dMode[whichTouched]==cpBarScreen) { // gg - cpbars |
TickTock | 46:73e8716f976f | 380 | pollCP=true; |
TickTock | 42:4533b13b297d | 381 | } else if (dMode[whichTouched]==config1Screen) { |
TickTock | 23:cd03f9c3395e | 382 | mbed_reset(); |
TickTock | 42:4533b13b297d | 383 | } else if (dMode[whichTouched]==playbackScreen) { // pause/unpause |
TickTock | 36:dbd39c315258 | 384 | playbackEn=!playbackEn; |
TickTock | 36:dbd39c315258 | 385 | if(playbackEn){ |
TickTock | 36:dbd39c315258 | 386 | playback.attach(&playbackISR,playbackInt); |
TickTock | 36:dbd39c315258 | 387 | }else{ |
TickTock | 36:dbd39c315258 | 388 | playback.detach(); |
TickTock | 36:dbd39c315258 | 389 | } |
TickTock | 23:cd03f9c3395e | 390 | } |
TickTock | 23:cd03f9c3395e | 391 | break; |
TickTock | 23:cd03f9c3395e | 392 | case 20: |
TickTock | 23:cd03f9c3395e | 393 | case 50: |
TickTock | 42:4533b13b297d | 394 | if (dMode[whichTouched]==monitorScreen||dMode[whichTouched]==changedScreen) { |
TickTock | 23:cd03f9c3395e | 395 | indexOffset=indexOffset<77?indexOffset+4:80; |
TickTock | 42:4533b13b297d | 396 | } else if (dMode[whichTouched]==config1Screen) { |
TickTock | 23:cd03f9c3395e | 397 | sprintf(sTemp,"Saving config file.\n"); |
TickTock | 23:cd03f9c3395e | 398 | logMsg(sTemp); |
TickTock | 25:ddf0ec209f03 | 399 | saveConfig(); |
TickTock | 26:462ccb580472 | 400 | spkr.beep(2000,0.25); |
TickTock | 42:4533b13b297d | 401 | } else if (dMode[whichTouched]==playbackScreen) { // faster |
TickTock | 36:dbd39c315258 | 402 | if(playbackInt>.002){ |
TickTock | 36:dbd39c315258 | 403 | playbackInt/=2; |
TickTock | 36:dbd39c315258 | 404 | if(playbackEn){ |
TickTock | 36:dbd39c315258 | 405 | playback.detach(); |
TickTock | 36:dbd39c315258 | 406 | playback.attach(&playbackISR,playbackInt); |
TickTock | 36:dbd39c315258 | 407 | } |
TickTock | 36:dbd39c315258 | 408 | } |
TickTock | 23:cd03f9c3395e | 409 | } |
TickTock | 23:cd03f9c3395e | 410 | break; |
TickTock | 23:cd03f9c3395e | 411 | case 01: |
TickTock | 48:d1ce92104a1f | 412 | case 31: // row 2 left |
TickTock | 42:4533b13b297d | 413 | if (dMode[whichTouched]==config1Screen) { |
TickTock | 23:cd03f9c3395e | 414 | logEn = !logEn; |
TickTock | 40:0e6e71a7323f | 415 | if (!logEn) repeatPoll=false; // disable auto polling, too |
TickTock | 42:4533b13b297d | 416 | } else if (dMode[whichTouched]==dateScreen){ |
TickTock | 25:ddf0ec209f03 | 417 | dtMode=(dtMode<6)?dtMode+1:0; |
TickTock | 42:4533b13b297d | 418 | lastDMode[whichTouched]=99; |
TickTock | 23:cd03f9c3395e | 419 | } |
TickTock | 23:cd03f9c3395e | 420 | break; |
TickTock | 23:cd03f9c3395e | 421 | case 11: |
TickTock | 48:d1ce92104a1f | 422 | case 41: // row 2 center |
TickTock | 42:4533b13b297d | 423 | if (dMode[whichTouched]==config1Screen){ |
TickTock | 33:a277743ebdeb | 424 | repeatPoll = !repeatPoll&&logEn; |
TickTock | 33:a277743ebdeb | 425 | if (repeatPoll) { |
TickTock | 36:dbd39c315258 | 426 | autoPoll.attach(&autoPollISR,pollInt); |
TickTock | 33:a277743ebdeb | 427 | } else { |
TickTock | 36:dbd39c315258 | 428 | autoPoll.detach(); |
TickTock | 33:a277743ebdeb | 429 | } |
TickTock | 42:4533b13b297d | 430 | } else if (dMode[whichTouched]==playbackScreen) { |
TickTock | 36:dbd39c315258 | 431 | // Start/stop playback |
TickTock | 36:dbd39c315258 | 432 | if(!playbackOpen){ |
TickTock | 36:dbd39c315258 | 433 | if(!logOpen){ |
TickTock | 36:dbd39c315258 | 434 | file = fopen("/usb/playback.alc", "rb"); |
TickTock | 50:83d5864c64a0 | 435 | lastDMode[whichTouched]=99;//force refresh |
TickTock | 36:dbd39c315258 | 436 | if(file==NULL){ |
TickTock | 36:dbd39c315258 | 437 | sprintf(sTemp,"Unable to open /usb/playback.alc\n"); |
TickTock | 36:dbd39c315258 | 438 | logMsg(sTemp); |
TickTock | 36:dbd39c315258 | 439 | spkr.beep(1000,0.25); |
TickTock | 36:dbd39c315258 | 440 | } else { |
TickTock | 36:dbd39c315258 | 441 | playbackOpen = true; |
TickTock | 50:83d5864c64a0 | 442 | playbackEn=true; |
TickTock | 50:83d5864c64a0 | 443 | playback.attach(&playbackISR,playbackInt); |
TickTock | 36:dbd39c315258 | 444 | sprintf(sTemp,"Starting playback\n"); |
TickTock | 36:dbd39c315258 | 445 | logMsg(sTemp); |
TickTock | 36:dbd39c315258 | 446 | spkr.beep(2000,0.25); |
TickTock | 36:dbd39c315258 | 447 | can1.attach(&doNothing);// Stop recieving CAN data |
TickTock | 36:dbd39c315258 | 448 | can2.attach(&doNothing); |
TickTock | 36:dbd39c315258 | 449 | } |
TickTock | 36:dbd39c315258 | 450 | } else { |
TickTock | 36:dbd39c315258 | 451 | sprintf(sTemp,"Must stop logging first\n"); |
TickTock | 36:dbd39c315258 | 452 | logMsg(sTemp); |
TickTock | 36:dbd39c315258 | 453 | } |
TickTock | 36:dbd39c315258 | 454 | } else { |
TickTock | 36:dbd39c315258 | 455 | playback.detach(); |
TickTock | 36:dbd39c315258 | 456 | fclose(file); |
TickTock | 36:dbd39c315258 | 457 | playbackOpen=false; |
TickTock | 50:83d5864c64a0 | 458 | playbackEn=false; |
TickTock | 36:dbd39c315258 | 459 | can1.attach(&recieve1);// Restore CAN data recieve |
TickTock | 36:dbd39c315258 | 460 | can2.attach(&recieve2); |
TickTock | 42:4533b13b297d | 461 | lastDMode[whichTouched]=99; |
TickTock | 36:dbd39c315258 | 462 | } |
TickTock | 42:4533b13b297d | 463 | } else if (dMode[whichTouched]==dateScreen){ |
TickTock | 25:ddf0ec209f03 | 464 | upDate(dtMode,true); |
TickTock | 42:4533b13b297d | 465 | lastDMode[whichTouched]=99; |
TickTock | 25:ddf0ec209f03 | 466 | } |
TickTock | 23:cd03f9c3395e | 467 | break; |
TickTock | 23:cd03f9c3395e | 468 | case 21: |
TickTock | 48:d1ce92104a1f | 469 | case 51: // row 2 right button |
TickTock | 48:d1ce92104a1f | 470 | if (dMode[whichTouched]==config1Screen) { // gg - Batt Log Enable Button |
TickTock | 48:d1ce92104a1f | 471 | yesBattLog = !yesBattLog; |
TickTock | 48:d1ce92104a1f | 472 | |
TickTock | 48:d1ce92104a1f | 473 | } else if (dMode[whichTouched]==dateScreen){ |
TickTock | 25:ddf0ec209f03 | 474 | upDate(dtMode,false); |
TickTock | 42:4533b13b297d | 475 | lastDMode[whichTouched]=99; |
TickTock | 25:ddf0ec209f03 | 476 | } |
TickTock | 23:cd03f9c3395e | 477 | break; |
TickTock | 23:cd03f9c3395e | 478 | case 02: |
TickTock | 23:cd03f9c3395e | 479 | case 32: |
TickTock | 42:4533b13b297d | 480 | dMode[whichTouched]=dMode[whichTouched]>0?dMode[whichTouched]-1:maxScreens; |
TickTock | 22:a43df3905863 | 481 | break; |
TickTock | 23:cd03f9c3395e | 482 | case 12: |
TickTock | 23:cd03f9c3395e | 483 | case 42: |
TickTock | 43:e7f6f80590e3 | 484 | //secsNoTouch = userTimeout; // immediately exit config mode |
TickTock | 43:e7f6f80590e3 | 485 | sMode=0; |
TickTock | 43:e7f6f80590e3 | 486 | lastDMode[whichTouched]=99; // Repaint |
TickTock | 22:a43df3905863 | 487 | break; |
TickTock | 23:cd03f9c3395e | 488 | case 22: |
TickTock | 23:cd03f9c3395e | 489 | case 52: |
TickTock | 42:4533b13b297d | 490 | dMode[whichTouched]=dMode[whichTouched]<maxScreens?dMode[whichTouched]+1:0; |
TickTock | 22:a43df3905863 | 491 | break; |
TickTock | 22:a43df3905863 | 492 | default: |
TickTock | 25:ddf0ec209f03 | 493 | break; |
TickTock | 25:ddf0ec209f03 | 494 | } |
TickTock | 23:cd03f9c3395e | 495 | break; |
TickTock | 23:cd03f9c3395e | 496 | case 2: // numpad |
TickTock | 23:cd03f9c3395e | 497 | break; |
TickTock | 23:cd03f9c3395e | 498 | case 3: |
TickTock | 23:cd03f9c3395e | 499 | break; |
TickTock | 23:cd03f9c3395e | 500 | default: |
TickTock | 23:cd03f9c3395e | 501 | break; |
TickTock | 23:cd03f9c3395e | 502 | } // case sMode |
TickTock | 22:a43df3905863 | 503 | } //recently touched |
TickTock | 4:8d7759f4fe7a | 504 | } else { // userIdle |
TickTock | 8:67eed72f3e10 | 505 | if(sMode==1){ |
TickTock | 8:67eed72f3e10 | 506 | sMode=0; |
TickTock | 43:e7f6f80590e3 | 507 | lastDMode[whichTouched]=99; |
TickTock | 8:67eed72f3e10 | 508 | } |
TickTock | 4:8d7759f4fe7a | 509 | } |
TickTock | 34:4751a8259b18 | 510 | |
TickTock | 34:4751a8259b18 | 511 | if(tick){ // Executes once a second |
TickTock | 41:8d4609ea7259 | 512 | accV=floor(mon12V*scale12V*10+0.5)/10; //Round to nearest 10th |
TickTock | 35:5acbd8a64a89 | 513 | accOn=(accV>5)?true:false; |
TickTock | 49:a3d2c5bb3cfa | 514 | if(laccOn&&!accOn){ // Car turned off |
TickTock | 49:a3d2c5bb3cfa | 515 | //write efficiency history data |
TickTock | 49:a3d2c5bb3cfa | 516 | cfile = fopen("/local/ehist.cny", "w"); |
TickTock | 49:a3d2c5bb3cfa | 517 | if (cfile!=NULL){ // found a efficiency history file |
TickTock | 49:a3d2c5bb3cfa | 518 | for(i=0;i<39;i++){ |
TickTock | 49:a3d2c5bb3cfa | 519 | fprintf(cfile,"%f %f\r\n",mph[i],kW[i]); |
TickTock | 49:a3d2c5bb3cfa | 520 | } |
TickTock | 49:a3d2c5bb3cfa | 521 | fclose(cfile); |
TickTock | 49:a3d2c5bb3cfa | 522 | } |
TickTock | 49:a3d2c5bb3cfa | 523 | } |
TickTock | 49:a3d2c5bb3cfa | 524 | laccOn=accOn; |
TickTock | 36:dbd39c315258 | 525 | if(!accOn&&!logEn&&userIdle&&!playbackEn){ |
TickTock | 40:0e6e71a7323f | 526 | //sprintf(sTemp,"Display Off %4.2f\n",accV); |
TickTock | 40:0e6e71a7323f | 527 | //logMsg(sTemp); |
TickTock | 35:5acbd8a64a89 | 528 | dled = 0; // turn off display if car off and logging disabled and no user activity |
TickTock | 35:5acbd8a64a89 | 529 | }else if(!headlights){ |
TickTock | 35:5acbd8a64a89 | 530 | dled = ledHi; |
TickTock | 34:4751a8259b18 | 531 | }else{ |
TickTock | 35:5acbd8a64a89 | 532 | dled = ledLo; |
TickTock | 34:4751a8259b18 | 533 | } |
TickTock | 49:a3d2c5bb3cfa | 534 | |
TickTock | 49:a3d2c5bb3cfa | 535 | //compute historic efficiency |
TickTock | 41:8d4609ea7259 | 536 | if(numSsamples>0){ // Avoid div0 |
TickTock | 49:a3d2c5bb3cfa | 537 | mph[0]=((float) motorRPM)/numSsamples/215; // Empirically derived - may change car to car |
TickTock | 36:dbd39c315258 | 538 | }else{ |
TickTock | 49:a3d2c5bb3cfa | 539 | mph[0]=0; |
TickTock | 36:dbd39c315258 | 540 | } |
TickTock | 49:a3d2c5bb3cfa | 541 | if(mph[0]>99){ |
TickTock | 49:a3d2c5bb3cfa | 542 | mph[0]=0; |
TickTock | 49:a3d2c5bb3cfa | 543 | } |
TickTock | 49:a3d2c5bb3cfa | 544 | mpkWh[0]=mph[0]; |
TickTock | 41:8d4609ea7259 | 545 | if(numWsamples>0){ // Avoid div0 |
TickTock | 49:a3d2c5bb3cfa | 546 | kW[0]=((float) mWs_x4)/numWsamples/4e3; |
TickTock | 49:a3d2c5bb3cfa | 547 | mpkWh[0]/=kW[0]; |
TickTock | 49:a3d2c5bb3cfa | 548 | if (mpkWh[0]<0) { |
TickTock | 49:a3d2c5bb3cfa | 549 | mpkWh[0]=99;// negative means inf. |
TickTock | 49:a3d2c5bb3cfa | 550 | } |
TickTock | 41:8d4609ea7259 | 551 | }else{ |
TickTock | 49:a3d2c5bb3cfa | 552 | kW[0]=0; |
TickTock | 49:a3d2c5bb3cfa | 553 | mpkWh[0]=0; |
TickTock | 49:a3d2c5bb3cfa | 554 | } |
TickTock | 49:a3d2c5bb3cfa | 555 | //mpkWh[0]=floor(mpkWh[0]*10+0.5)/10; // Round to nearest 10th |
TickTock | 49:a3d2c5bb3cfa | 556 | motorRPM=0; |
TickTock | 41:8d4609ea7259 | 557 | numSsamples=0; |
TickTock | 40:0e6e71a7323f | 558 | mWs_x4=0; |
TickTock | 40:0e6e71a7323f | 559 | numWsamples=0; |
TickTock | 53:8a51361434ae | 560 | if(accOn||playbackEn){ |
TickTock | 52:d5385fbf4ea1 | 561 | for(i=1;i<39;i++){ |
TickTock | 49:a3d2c5bb3cfa | 562 | average=mph[i]/timeConstant[i]; |
TickTock | 49:a3d2c5bb3cfa | 563 | mph[i]-=average; |
TickTock | 52:d5385fbf4ea1 | 564 | mph[i]+=mph[0]; |
TickTock | 52:d5385fbf4ea1 | 565 | mpkWh[i]=average; |
TickTock | 49:a3d2c5bb3cfa | 566 | average=kW[i]/timeConstant[i]; |
TickTock | 49:a3d2c5bb3cfa | 567 | kW[i]-=average; |
TickTock | 52:d5385fbf4ea1 | 568 | kW[i]+=kW[0]; |
TickTock | 52:d5385fbf4ea1 | 569 | mpkWh[i]/=average; |
TickTock | 49:a3d2c5bb3cfa | 570 | if (mpkWh[i]<0) { |
TickTock | 49:a3d2c5bb3cfa | 571 | mpkWh[i]=99;// negative means inf. |
TickTock | 49:a3d2c5bb3cfa | 572 | } |
TickTock | 49:a3d2c5bb3cfa | 573 | //mpkWh[i]=floor(mpkWh[i]*10+0.5)/10; // Round to nearest 10th |
TickTock | 52:d5385fbf4ea1 | 574 | } |
TickTock | 49:a3d2c5bb3cfa | 575 | } |
TickTock | 49:a3d2c5bb3cfa | 576 | updateDTE=true; |
TickTock | 40:0e6e71a7323f | 577 | if(logCP) |
TickTock | 40:0e6e71a7323f | 578 | logPackVoltages(); // Turbo3 |
TickTock | 34:4751a8259b18 | 579 | tick=false; |
TickTock | 33:a277743ebdeb | 580 | } |
TickTock | 36:dbd39c315258 | 581 | |
TickTock | 39:eef8beac7411 | 582 | display=display<1?display+1:0; // toggle display |
TickTock | 39:eef8beac7411 | 583 | updateDisplay(display); |
TickTock | 39:eef8beac7411 | 584 | |
TickTock | 39:eef8beac7411 | 585 | if(pollCP){ // We do this inside main loop instead of ticker so CAN RX will not be blocked |
TickTock | 39:eef8beac7411 | 586 | sendCPreq(); // send cellpair data request. |
TickTock | 39:eef8beac7411 | 587 | wait_ms(16); |
TickTock | 39:eef8beac7411 | 588 | sendTreq(); //send temperature request |
TickTock | 39:eef8beac7411 | 589 | pollCP=false; |
TickTock | 39:eef8beac7411 | 590 | } |
TickTock | 39:eef8beac7411 | 591 | |
TickTock | 36:dbd39c315258 | 592 | if(step){ // playback |
TickTock | 36:dbd39c315258 | 593 | if(playbackOpen&&playbackEn){ |
TickTock | 38:155ec32c5e91 | 594 | for(i=0;i<120;i++){ |
TickTock | 36:dbd39c315258 | 595 | if(!feof(file)){ |
TickTock | 37:fea2c1d52c5f | 596 | fscanf(file,"%5c%8c",&header,&data); |
TickTock | 37:fea2c1d52c5f | 597 | logCan(header[0],CANMessage(0x7ff&((header[4]<<8)+header[3]), data, 8)); |
TickTock | 36:dbd39c315258 | 598 | }else{ |
TickTock | 36:dbd39c315258 | 599 | fclose(file); // restart |
TickTock | 36:dbd39c315258 | 600 | file = fopen("/usb/playback.alc", "rb"); |
TickTock | 50:83d5864c64a0 | 601 | lastDMode[whichTouched]=99;//force refresh |
TickTock | 36:dbd39c315258 | 602 | spkr.beep(2000,0.25); |
TickTock | 36:dbd39c315258 | 603 | } |
TickTock | 36:dbd39c315258 | 604 | } |
TickTock | 36:dbd39c315258 | 605 | } |
TickTock | 36:dbd39c315258 | 606 | step=false; |
TickTock | 36:dbd39c315258 | 607 | } |
TickTock | 37:fea2c1d52c5f | 608 | |
TickTock | 2:71b1999a8ea5 | 609 | } //while (true) |
TickTock | 0:1596b8644523 | 610 | } |