Dual CANbus monitor and instrumentation cluster supporting ILI9341 display controller
Dependencies: SPI_TFTx2_ILI9341 TOUCH_TFTx2_ILI9341 TFT_fonts mbed
Fork of CANary by
main.cpp@45:6069010de7d7, 2013-04-02 (annotated)
- Committer:
- TickTock
- Date:
- Tue Apr 02 06:55:43 2013 +0000
- Revision:
- 45:6069010de7d7
- Parent:
- 44:6262a9fd1e56
- Child:
- 46:73e8716f976f
fixed rev number
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 | 45:6069010de7d7 | 144 | sprintf(sTemp,"CANary firmware rev45\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 | 43:e7f6f80590e3 | 183 | dMode[1]=logScreen; |
TickTock | 43:e7f6f80590e3 | 184 | lastDMode[1]=99; |
TickTock | 43:e7f6f80590e3 | 185 | updateDisplay(1); |
TickTock | 43:e7f6f80590e3 | 186 | |
TickTock | 26:462ccb580472 | 187 | // Read config file |
TickTock | 23:cd03f9c3395e | 188 | readConfig(); |
TickTock | 43:e7f6f80590e3 | 189 | wait_ms(4000); // Pause for a few seconds |
TickTock | 43:e7f6f80590e3 | 190 | |
TickTock | 26:462ccb580472 | 191 | touched=false; |
TickTock | 26:462ccb580472 | 192 | secsNoTouch=2; |
TickTock | 2:71b1999a8ea5 | 193 | while (true) { |
TickTock | 4:8d7759f4fe7a | 194 | if (!logOpen) { // Open new file if one is not already open |
TickTock | 7:17bf9ceaf0aa | 195 | if(logEn){ //logging enable |
TickTock | 7:17bf9ceaf0aa | 196 | seconds = time(NULL); |
TickTock | 7:17bf9ceaf0aa | 197 | t = *localtime(&seconds) ; |
TickTock | 35:5acbd8a64a89 | 198 | strftime(fileName, 32, "/usb/%m%d%H%M.alc", &t); //mmddhhmm.alc |
TickTock | 16:2a6ca248e1cb | 199 | //sprintf(sTemp,"Using file %s\n",fileName); |
TickTock | 16:2a6ca248e1cb | 200 | //logMsg(sTemp); |
TickTock | 7:17bf9ceaf0aa | 201 | file = fopen(fileName, "ab"); |
TickTock | 7:17bf9ceaf0aa | 202 | |
TickTock | 7:17bf9ceaf0aa | 203 | if(file==NULL){ |
TickTock | 7:17bf9ceaf0aa | 204 | sprintf(sTemp,"\nUnable to open %s\n\n\n\n",fileName); |
TickTock | 7:17bf9ceaf0aa | 205 | logMsg(sTemp); |
TickTock | 7:17bf9ceaf0aa | 206 | logEn=false; |
TickTock | 26:462ccb580472 | 207 | spkr.beep(1000,0.25); |
TickTock | 7:17bf9ceaf0aa | 208 | } else { |
TickTock | 7:17bf9ceaf0aa | 209 | logOpen = true; |
TickTock | 7:17bf9ceaf0aa | 210 | readPointer=writePointer; |
TickTock | 7:17bf9ceaf0aa | 211 | sprintf(sTemp,"Starting Can Log %s\n",fileName); |
TickTock | 7:17bf9ceaf0aa | 212 | logMsg(sTemp); |
TickTock | 7:17bf9ceaf0aa | 213 | logTS(); |
TickTock | 26:462ccb580472 | 214 | spkr.beep(2000,0.25); |
TickTock | 7:17bf9ceaf0aa | 215 | } |
TickTock | 7:17bf9ceaf0aa | 216 | }//logging enabled |
TickTock | 15:a359fecf85ba | 217 | } else { // if (logOpen) |
TickTock | 30:e633a63eb257 | 218 | if (((writePointer+maxBufLen-readPointer)%maxBufLen)>(maxBufLen/16)||canIdle||!logEn) { |
TickTock | 7:17bf9ceaf0aa | 219 | // Dump buffer if > 1/16 full or canbus has stopped |
TickTock | 7:17bf9ceaf0aa | 220 | if (file == NULL) { |
TickTock | 7:17bf9ceaf0aa | 221 | logOpen = false; |
TickTock | 37:fea2c1d52c5f | 222 | sprintf(sTemp,"Failed to append log file.\n"); |
TickTock | 37:fea2c1d52c5f | 223 | logMsg(sTemp); |
TickTock | 26:462ccb580472 | 224 | spkr.beep(1000,0.25); |
TickTock | 7:17bf9ceaf0aa | 225 | logEn=false; |
TickTock | 7:17bf9ceaf0aa | 226 | } else { |
TickTock | 37:fea2c1d52c5f | 227 | if (((writePointer+maxBufLen-readPointer)%maxBufLen)>(maxBufLen*7/8)) { // Hi-water mark |
TickTock | 37:fea2c1d52c5f | 228 | sprintf(sTemp,"Write buffer overrun.\n"); |
TickTock | 37:fea2c1d52c5f | 229 | logMsg(sTemp); |
TickTock | 37:fea2c1d52c5f | 230 | spkr.beep(1000,0.25); |
TickTock | 37:fea2c1d52c5f | 231 | } |
TickTock | 7:17bf9ceaf0aa | 232 | while (readPointer != writePointer) { |
TickTock | 7:17bf9ceaf0aa | 233 | for (j = 0; j<13; j++){ |
TickTock | 7:17bf9ceaf0aa | 234 | fprintf(file,"%c",writeBuffer[readPointer][j]); |
TickTock | 4:8d7759f4fe7a | 235 | } |
TickTock | 7:17bf9ceaf0aa | 236 | if(++readPointer >= maxBufLen) |
TickTock | 7:17bf9ceaf0aa | 237 | readPointer=0; |
TickTock | 4:8d7759f4fe7a | 238 | } |
TickTock | 7:17bf9ceaf0aa | 239 | led4 = !led4; |
TickTock | 7:17bf9ceaf0aa | 240 | } |
TickTock | 30:e633a63eb257 | 241 | } // if > 1/16 full, canbus has stopped, or logging stopped |
TickTock | 30:e633a63eb257 | 242 | if (!logEn) { |
TickTock | 30:e633a63eb257 | 243 | fclose(file); |
TickTock | 30:e633a63eb257 | 244 | logOpen=false; |
TickTock | 30:e633a63eb257 | 245 | } |
TickTock | 4:8d7759f4fe7a | 246 | } // if logOpen |
TickTock | 36:dbd39c315258 | 247 | if (canIdle&&userIdle&&!playbackEn) { // canbus idle --> sleep to save power |
TickTock | 26:462ccb580472 | 248 | if (logOpen){ |
TickTock | 7:17bf9ceaf0aa | 249 | fclose(file); |
TickTock | 7:17bf9ceaf0aa | 250 | } // if (logOpen)*/ |
TickTock | 20:3bf176d14b14 | 251 | seconds = time(NULL); |
TickTock | 20:3bf176d14b14 | 252 | t = *localtime(&seconds) ; |
TickTock | 21:22bdce9efcb5 | 253 | strftime(sTemp, 40, "Sleeping: %a %m/%d/%Y %X\n", &t); |
TickTock | 4:8d7759f4fe7a | 254 | logMsg(sTemp); |
TickTock | 25:ddf0ec209f03 | 255 | updateDisplay(0); //Added for turbo3 who has a display override and wants to see the sleep message before going to sleep |
TickTock | 25:ddf0ec209f03 | 256 | updateDisplay(1); |
TickTock | 4:8d7759f4fe7a | 257 | //LPC_RTC->CIIR=0x00; // block RTC interrupts |
TickTock | 4:8d7759f4fe7a | 258 | led1=0; |
TickTock | 4:8d7759f4fe7a | 259 | led2=0; |
TickTock | 4:8d7759f4fe7a | 260 | led3=0; |
TickTock | 4:8d7759f4fe7a | 261 | led4=0; |
TickTock | 4:8d7759f4fe7a | 262 | dled=0; // turn off display |
TickTock | 4:8d7759f4fe7a | 263 | secs = time(NULL); // seconds past 12:00:00 AM 1 Jan 1900 |
TickTock | 22:a43df3905863 | 264 | while (secsNoMsg>canTimeout && !touched) { |
TickTock | 4:8d7759f4fe7a | 265 | //DeepPowerDown(); |
TickTock | 12:8e42d7ba8468 | 266 | tt.wfi(); //enable touch interrupt |
TickTock | 21:22bdce9efcb5 | 267 | //__wfi(); // freeze CPU and wait for interrupt (from canbus or touch) |
TickTock | 21:22bdce9efcb5 | 268 | Sleep(); |
TickTock | 4:8d7759f4fe7a | 269 | } |
TickTock | 43:e7f6f80590e3 | 270 | secsNoTouch=2; |
TickTock | 4:8d7759f4fe7a | 271 | canIdle=secsNoMsg>canTimeout; |
TickTock | 43:e7f6f80590e3 | 272 | //userIdle=!touched; |
TickTock | 7:17bf9ceaf0aa | 273 | dled=0.8; // turn on display LED |
TickTock | 20:3bf176d14b14 | 274 | seconds = time(NULL); |
TickTock | 20:3bf176d14b14 | 275 | t = *localtime(&seconds) ; |
TickTock | 21:22bdce9efcb5 | 276 | strftime(sTemp, 40, "Waking: %a %m/%d/%Y %X\n", &t); |
TickTock | 4:8d7759f4fe7a | 277 | logMsg(sTemp); |
TickTock | 4:8d7759f4fe7a | 278 | if (time(NULL)>(secs+1800)) { |
TickTock | 4:8d7759f4fe7a | 279 | logOpen = false; // Start new file if asleep for more than 30 minutes |
TickTock | 4:8d7759f4fe7a | 280 | if (secsNoTouch>100) secsNoTouch = 100; // also mostly reset user Idle counter |
TickTock | 43:e7f6f80590e3 | 281 | } else if (logOpen){ // insert timestamp on each wake if logging enabled (disabled for now) |
TickTock | 7:17bf9ceaf0aa | 282 | file = fopen(fileName, "ab"); |
TickTock | 4:8d7759f4fe7a | 283 | logTS(); |
TickTock | 4:8d7759f4fe7a | 284 | } |
TickTock | 4:8d7759f4fe7a | 285 | } // if idle |
TickTock | 4:8d7759f4fe7a | 286 | |
TickTock | 15:a359fecf85ba | 287 | if(touched){ // call touchscreen procedure if touch interrupt detected |
TickTock | 7:17bf9ceaf0aa | 288 | lastTouch = tt.get_touch(); |
TickTock | 7:17bf9ceaf0aa | 289 | lastTouch = tt.to_pixel(lastTouch); // convert to pixel pos |
TickTock | 40:0e6e71a7323f | 290 | if((lastTouch.x!=639)&&(lastTouch.x!=319)&&(lastTouch.y!=239)){ // filter phantom touches |
TickTock | 43:e7f6f80590e3 | 291 | if (userIdle) { |
TickTock | 43:e7f6f80590e3 | 292 | secsNoTouch=2; // Ignore first touch if user idle |
TickTock | 43:e7f6f80590e3 | 293 | userIdle=false; |
TickTock | 40:0e6e71a7323f | 294 | } else { |
TickTock | 43:e7f6f80590e3 | 295 | secsNoTouch=0; |
TickTock | 40:0e6e71a7323f | 296 | } |
TickTock | 43:e7f6f80590e3 | 297 | if (lastTouch.x>320){ |
TickTock | 43:e7f6f80590e3 | 298 | whichTouched=1; |
TickTock | 43:e7f6f80590e3 | 299 | } else { |
TickTock | 43:e7f6f80590e3 | 300 | whichTouched=0; |
TickTock | 43:e7f6f80590e3 | 301 | } |
TickTock | 43:e7f6f80590e3 | 302 | if (whichTouched!=lwt){ |
TickTock | 43:e7f6f80590e3 | 303 | lastDMode[lwt]=99; // Repaint lastTouched |
TickTock | 43:e7f6f80590e3 | 304 | lwt=whichTouched; |
TickTock | 43:e7f6f80590e3 | 305 | } |
TickTock | 43:e7f6f80590e3 | 306 | sMode = 1; |
TickTock | 22:a43df3905863 | 307 | } |
TickTock | 22:a43df3905863 | 308 | //sprintf(sTemp,"%d,%d ",lastTouch.x,lastTouch.y); |
TickTock | 22:a43df3905863 | 309 | //logMsg(sTemp); |
TickTock | 12:8e42d7ba8468 | 310 | touched = false; // clear interrupt flag |
TickTock | 7:17bf9ceaf0aa | 311 | } |
TickTock | 4:8d7759f4fe7a | 312 | if (!userIdle) { |
TickTock | 4:8d7759f4fe7a | 313 | if (secsNoTouch<2) {// Recently touched |
TickTock | 4:8d7759f4fe7a | 314 | secsNoTouch +=2; // increment to prevent double touch |
TickTock | 43:e7f6f80590e3 | 315 | sMode = 1; |
TickTock | 22:a43df3905863 | 316 | //sprintf(sTemp,"button %d %d,%d %d\n",i,buttonX(lastTouch.x,3),buttonY(lastTouch.y,3),lastTouch.x); |
TickTock | 22:a43df3905863 | 317 | //logMsg(sTemp); |
TickTock | 23:cd03f9c3395e | 318 | switch (sMode) { |
TickTock | 23:cd03f9c3395e | 319 | case 0: // no select |
TickTock | 23:cd03f9c3395e | 320 | break; |
TickTock | 23:cd03f9c3395e | 321 | case 1: // select screen |
TickTock | 23:cd03f9c3395e | 322 | switch (buttonX(lastTouch.x,3)*10+buttonY(lastTouch.y,3)) { |
TickTock | 23:cd03f9c3395e | 323 | case 00: |
TickTock | 23:cd03f9c3395e | 324 | case 30: |
TickTock | 42:4533b13b297d | 325 | if (dMode[whichTouched]==monitorScreen||dMode[whichTouched]==changedScreen) { |
TickTock | 23:cd03f9c3395e | 326 | indexOffset=indexOffset>4?indexOffset-4:1; |
TickTock | 42:4533b13b297d | 327 | } else if (dMode[whichTouched]==config1Screen) { |
TickTock | 23:cd03f9c3395e | 328 | wait_ms(500); |
TickTock | 37:fea2c1d52c5f | 329 | tt.background(Black); |
TickTock | 23:cd03f9c3395e | 330 | tt.calibrate(); |
TickTock | 42:4533b13b297d | 331 | } else if (dMode[whichTouched]==playbackScreen) { // slower |
TickTock | 36:dbd39c315258 | 332 | playbackInt *=2; |
TickTock | 36:dbd39c315258 | 333 | if(playbackEn){ |
TickTock | 36:dbd39c315258 | 334 | playback.detach(); |
TickTock | 36:dbd39c315258 | 335 | playback.attach(&playbackISR,playbackInt); |
TickTock | 36:dbd39c315258 | 336 | } |
TickTock | 23:cd03f9c3395e | 337 | } |
TickTock | 23:cd03f9c3395e | 338 | break; |
TickTock | 23:cd03f9c3395e | 339 | case 10: |
TickTock | 23:cd03f9c3395e | 340 | case 40: |
TickTock | 42:4533b13b297d | 341 | if (dMode[whichTouched]==changedScreen) { |
TickTock | 23:cd03f9c3395e | 342 | for(j=0;j<100;j++) msgChanged[j]=0; // clear changed data |
TickTock | 42:4533b13b297d | 343 | lastDMode[whichTouched]=99;//force refresh |
TickTock | 42:4533b13b297d | 344 | } else if (dMode[whichTouched]==cpScreen) { |
TickTock | 33:a277743ebdeb | 345 | pollCP=true; |
TickTock | 42:4533b13b297d | 346 | } else if (dMode[whichTouched]==config1Screen) { |
TickTock | 23:cd03f9c3395e | 347 | mbed_reset(); |
TickTock | 42:4533b13b297d | 348 | } else if (dMode[whichTouched]==playbackScreen) { // pause/unpause |
TickTock | 36:dbd39c315258 | 349 | playbackEn=!playbackEn; |
TickTock | 36:dbd39c315258 | 350 | if(playbackEn){ |
TickTock | 36:dbd39c315258 | 351 | playback.attach(&playbackISR,playbackInt); |
TickTock | 36:dbd39c315258 | 352 | }else{ |
TickTock | 36:dbd39c315258 | 353 | playback.detach(); |
TickTock | 36:dbd39c315258 | 354 | } |
TickTock | 23:cd03f9c3395e | 355 | } |
TickTock | 23:cd03f9c3395e | 356 | break; |
TickTock | 23:cd03f9c3395e | 357 | case 20: |
TickTock | 23:cd03f9c3395e | 358 | case 50: |
TickTock | 42:4533b13b297d | 359 | if (dMode[whichTouched]==monitorScreen||dMode[whichTouched]==changedScreen) { |
TickTock | 23:cd03f9c3395e | 360 | indexOffset=indexOffset<77?indexOffset+4:80; |
TickTock | 42:4533b13b297d | 361 | } else if (dMode[whichTouched]==config1Screen) { |
TickTock | 23:cd03f9c3395e | 362 | sprintf(sTemp,"Saving config file.\n"); |
TickTock | 23:cd03f9c3395e | 363 | logMsg(sTemp); |
TickTock | 25:ddf0ec209f03 | 364 | saveConfig(); |
TickTock | 26:462ccb580472 | 365 | spkr.beep(2000,0.25); |
TickTock | 42:4533b13b297d | 366 | } else if (dMode[whichTouched]==playbackScreen) { // faster |
TickTock | 36:dbd39c315258 | 367 | if(playbackInt>.002){ |
TickTock | 36:dbd39c315258 | 368 | playbackInt/=2; |
TickTock | 36:dbd39c315258 | 369 | if(playbackEn){ |
TickTock | 36:dbd39c315258 | 370 | playback.detach(); |
TickTock | 36:dbd39c315258 | 371 | playback.attach(&playbackISR,playbackInt); |
TickTock | 36:dbd39c315258 | 372 | } |
TickTock | 36:dbd39c315258 | 373 | } |
TickTock | 23:cd03f9c3395e | 374 | } |
TickTock | 23:cd03f9c3395e | 375 | break; |
TickTock | 23:cd03f9c3395e | 376 | case 01: |
TickTock | 23:cd03f9c3395e | 377 | case 31: |
TickTock | 42:4533b13b297d | 378 | if (dMode[whichTouched]==config1Screen) { |
TickTock | 23:cd03f9c3395e | 379 | logEn = !logEn; |
TickTock | 40:0e6e71a7323f | 380 | if (!logEn) repeatPoll=false; // disable auto polling, too |
TickTock | 42:4533b13b297d | 381 | } else if (dMode[whichTouched]==dateScreen){ |
TickTock | 25:ddf0ec209f03 | 382 | dtMode=(dtMode<6)?dtMode+1:0; |
TickTock | 42:4533b13b297d | 383 | lastDMode[whichTouched]=99; |
TickTock | 23:cd03f9c3395e | 384 | } |
TickTock | 23:cd03f9c3395e | 385 | break; |
TickTock | 23:cd03f9c3395e | 386 | case 11: |
TickTock | 23:cd03f9c3395e | 387 | case 41: |
TickTock | 42:4533b13b297d | 388 | if (dMode[whichTouched]==config1Screen){ |
TickTock | 33:a277743ebdeb | 389 | repeatPoll = !repeatPoll&&logEn; |
TickTock | 33:a277743ebdeb | 390 | if (repeatPoll) { |
TickTock | 36:dbd39c315258 | 391 | autoPoll.attach(&autoPollISR,pollInt); |
TickTock | 33:a277743ebdeb | 392 | } else { |
TickTock | 36:dbd39c315258 | 393 | autoPoll.detach(); |
TickTock | 33:a277743ebdeb | 394 | } |
TickTock | 42:4533b13b297d | 395 | } else if (dMode[whichTouched]==playbackScreen) { |
TickTock | 36:dbd39c315258 | 396 | // Start/stop playback |
TickTock | 36:dbd39c315258 | 397 | if(!playbackOpen){ |
TickTock | 36:dbd39c315258 | 398 | if(!logOpen){ |
TickTock | 36:dbd39c315258 | 399 | file = fopen("/usb/playback.alc", "rb"); |
TickTock | 36:dbd39c315258 | 400 | if(file==NULL){ |
TickTock | 36:dbd39c315258 | 401 | sprintf(sTemp,"Unable to open /usb/playback.alc\n"); |
TickTock | 36:dbd39c315258 | 402 | logMsg(sTemp); |
TickTock | 36:dbd39c315258 | 403 | spkr.beep(1000,0.25); |
TickTock | 36:dbd39c315258 | 404 | } else { |
TickTock | 36:dbd39c315258 | 405 | playbackOpen = true; |
TickTock | 36:dbd39c315258 | 406 | sprintf(sTemp,"Starting playback\n"); |
TickTock | 36:dbd39c315258 | 407 | logMsg(sTemp); |
TickTock | 36:dbd39c315258 | 408 | spkr.beep(2000,0.25); |
TickTock | 36:dbd39c315258 | 409 | can1.attach(&doNothing);// Stop recieving CAN data |
TickTock | 36:dbd39c315258 | 410 | can2.attach(&doNothing); |
TickTock | 36:dbd39c315258 | 411 | } |
TickTock | 36:dbd39c315258 | 412 | } else { |
TickTock | 36:dbd39c315258 | 413 | sprintf(sTemp,"Must stop logging first\n"); |
TickTock | 36:dbd39c315258 | 414 | logMsg(sTemp); |
TickTock | 36:dbd39c315258 | 415 | } |
TickTock | 36:dbd39c315258 | 416 | } else { |
TickTock | 36:dbd39c315258 | 417 | playback.detach(); |
TickTock | 36:dbd39c315258 | 418 | fclose(file); |
TickTock | 36:dbd39c315258 | 419 | playbackOpen=false; |
TickTock | 36:dbd39c315258 | 420 | can1.attach(&recieve1);// Restore CAN data recieve |
TickTock | 36:dbd39c315258 | 421 | can2.attach(&recieve2); |
TickTock | 42:4533b13b297d | 422 | lastDMode[whichTouched]=99; |
TickTock | 36:dbd39c315258 | 423 | } |
TickTock | 36:dbd39c315258 | 424 | playbackEn=false; |
TickTock | 42:4533b13b297d | 425 | } else if (dMode[whichTouched]==dateScreen){ |
TickTock | 25:ddf0ec209f03 | 426 | upDate(dtMode,true); |
TickTock | 42:4533b13b297d | 427 | lastDMode[whichTouched]=99; |
TickTock | 25:ddf0ec209f03 | 428 | } |
TickTock | 23:cd03f9c3395e | 429 | break; |
TickTock | 23:cd03f9c3395e | 430 | case 21: |
TickTock | 23:cd03f9c3395e | 431 | case 51: |
TickTock | 42:4533b13b297d | 432 | if (dMode[whichTouched]==dateScreen){ |
TickTock | 25:ddf0ec209f03 | 433 | upDate(dtMode,false); |
TickTock | 42:4533b13b297d | 434 | lastDMode[whichTouched]=99; |
TickTock | 25:ddf0ec209f03 | 435 | } |
TickTock | 23:cd03f9c3395e | 436 | break; |
TickTock | 23:cd03f9c3395e | 437 | case 02: |
TickTock | 23:cd03f9c3395e | 438 | case 32: |
TickTock | 42:4533b13b297d | 439 | dMode[whichTouched]=dMode[whichTouched]>0?dMode[whichTouched]-1:maxScreens; |
TickTock | 22:a43df3905863 | 440 | break; |
TickTock | 23:cd03f9c3395e | 441 | case 12: |
TickTock | 23:cd03f9c3395e | 442 | case 42: |
TickTock | 43:e7f6f80590e3 | 443 | //secsNoTouch = userTimeout; // immediately exit config mode |
TickTock | 43:e7f6f80590e3 | 444 | sMode=0; |
TickTock | 43:e7f6f80590e3 | 445 | lastDMode[whichTouched]=99; // Repaint |
TickTock | 22:a43df3905863 | 446 | break; |
TickTock | 23:cd03f9c3395e | 447 | case 22: |
TickTock | 23:cd03f9c3395e | 448 | case 52: |
TickTock | 42:4533b13b297d | 449 | dMode[whichTouched]=dMode[whichTouched]<maxScreens?dMode[whichTouched]+1:0; |
TickTock | 22:a43df3905863 | 450 | break; |
TickTock | 22:a43df3905863 | 451 | default: |
TickTock | 25:ddf0ec209f03 | 452 | break; |
TickTock | 25:ddf0ec209f03 | 453 | } |
TickTock | 23:cd03f9c3395e | 454 | break; |
TickTock | 23:cd03f9c3395e | 455 | case 2: // numpad |
TickTock | 23:cd03f9c3395e | 456 | break; |
TickTock | 23:cd03f9c3395e | 457 | case 3: |
TickTock | 23:cd03f9c3395e | 458 | break; |
TickTock | 23:cd03f9c3395e | 459 | default: |
TickTock | 23:cd03f9c3395e | 460 | break; |
TickTock | 23:cd03f9c3395e | 461 | } // case sMode |
TickTock | 22:a43df3905863 | 462 | } //recently touched |
TickTock | 4:8d7759f4fe7a | 463 | } else { // userIdle |
TickTock | 8:67eed72f3e10 | 464 | if(sMode==1){ |
TickTock | 8:67eed72f3e10 | 465 | sMode=0; |
TickTock | 43:e7f6f80590e3 | 466 | lastDMode[whichTouched]=99; |
TickTock | 8:67eed72f3e10 | 467 | } |
TickTock | 4:8d7759f4fe7a | 468 | } |
TickTock | 34:4751a8259b18 | 469 | |
TickTock | 34:4751a8259b18 | 470 | if(tick){ // Executes once a second |
TickTock | 41:8d4609ea7259 | 471 | accV=floor(mon12V*scale12V*10+0.5)/10; //Round to nearest 10th |
TickTock | 35:5acbd8a64a89 | 472 | accOn=(accV>5)?true:false; |
TickTock | 36:dbd39c315258 | 473 | if(!accOn&&!logEn&&userIdle&&!playbackEn){ |
TickTock | 40:0e6e71a7323f | 474 | //sprintf(sTemp,"Display Off %4.2f\n",accV); |
TickTock | 40:0e6e71a7323f | 475 | //logMsg(sTemp); |
TickTock | 35:5acbd8a64a89 | 476 | dled = 0; // turn off display if car off and logging disabled and no user activity |
TickTock | 35:5acbd8a64a89 | 477 | }else if(!headlights){ |
TickTock | 35:5acbd8a64a89 | 478 | dled = ledHi; |
TickTock | 34:4751a8259b18 | 479 | }else{ |
TickTock | 35:5acbd8a64a89 | 480 | dled = ledLo; |
TickTock | 34:4751a8259b18 | 481 | } |
TickTock | 41:8d4609ea7259 | 482 | if(numSsamples>0){ // Avoid div0 |
TickTock | 41:8d4609ea7259 | 483 | MPH=((float) motorRPM)/numSsamples/215; // Empirically derived - may change car to car |
TickTock | 36:dbd39c315258 | 484 | }else{ |
TickTock | 41:8d4609ea7259 | 485 | MPH=0; |
TickTock | 36:dbd39c315258 | 486 | } |
TickTock | 41:8d4609ea7259 | 487 | if(numWsamples>0){ // Avoid div0 |
TickTock | 41:8d4609ea7259 | 488 | kW=((float) mWs_x4)/numWsamples/4e3; |
TickTock | 41:8d4609ea7259 | 489 | mpkWh=floor(MPH*10/kW+0.5)/10; // Round to nearest 10th |
TickTock | 41:8d4609ea7259 | 490 | }else{ |
TickTock | 41:8d4609ea7259 | 491 | kW=0; |
TickTock | 41:8d4609ea7259 | 492 | } motorRPM=0; |
TickTock | 41:8d4609ea7259 | 493 | numSsamples=0; |
TickTock | 40:0e6e71a7323f | 494 | mWs_x4=0; |
TickTock | 40:0e6e71a7323f | 495 | numWsamples=0; |
TickTock | 40:0e6e71a7323f | 496 | if(logCP) |
TickTock | 40:0e6e71a7323f | 497 | logPackVoltages(); // Turbo3 |
TickTock | 34:4751a8259b18 | 498 | tick=false; |
TickTock | 33:a277743ebdeb | 499 | } |
TickTock | 36:dbd39c315258 | 500 | |
TickTock | 39:eef8beac7411 | 501 | display=display<1?display+1:0; // toggle display |
TickTock | 39:eef8beac7411 | 502 | updateDisplay(display); |
TickTock | 39:eef8beac7411 | 503 | |
TickTock | 39:eef8beac7411 | 504 | if(pollCP){ // We do this inside main loop instead of ticker so CAN RX will not be blocked |
TickTock | 39:eef8beac7411 | 505 | sendCPreq(); // send cellpair data request. |
TickTock | 39:eef8beac7411 | 506 | wait_ms(16); |
TickTock | 39:eef8beac7411 | 507 | sendTreq(); //send temperature request |
TickTock | 39:eef8beac7411 | 508 | pollCP=false; |
TickTock | 39:eef8beac7411 | 509 | } |
TickTock | 39:eef8beac7411 | 510 | |
TickTock | 36:dbd39c315258 | 511 | if(step){ // playback |
TickTock | 36:dbd39c315258 | 512 | if(playbackOpen&&playbackEn){ |
TickTock | 38:155ec32c5e91 | 513 | for(i=0;i<120;i++){ |
TickTock | 36:dbd39c315258 | 514 | if(!feof(file)){ |
TickTock | 37:fea2c1d52c5f | 515 | fscanf(file,"%5c%8c",&header,&data); |
TickTock | 37:fea2c1d52c5f | 516 | logCan(header[0],CANMessage(0x7ff&((header[4]<<8)+header[3]), data, 8)); |
TickTock | 36:dbd39c315258 | 517 | }else{ |
TickTock | 36:dbd39c315258 | 518 | fclose(file); // restart |
TickTock | 36:dbd39c315258 | 519 | file = fopen("/usb/playback.alc", "rb"); |
TickTock | 36:dbd39c315258 | 520 | spkr.beep(2000,0.25); |
TickTock | 36:dbd39c315258 | 521 | } |
TickTock | 36:dbd39c315258 | 522 | } |
TickTock | 36:dbd39c315258 | 523 | } |
TickTock | 36:dbd39c315258 | 524 | step=false; |
TickTock | 36:dbd39c315258 | 525 | } |
TickTock | 37:fea2c1d52c5f | 526 | |
TickTock | 2:71b1999a8ea5 | 527 | } //while (true) |
TickTock | 0:1596b8644523 | 528 | } |