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