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