Attempts to merge SPI_TFT2 & SPI_TFT_ILI9341
Dependencies: SPI_TFTx2 TFT_fonts TOUCH_TFTx2 mbed
Fork of CANary by
main.cpp@126:e0d039096891, 2013-07-21 (annotated)
- Committer:
- TickTock
- Date:
- Sun Jul 21 11:23:57 2013 +0000
- Branch:
- Metric
- Revision:
- 126:e0d039096891
- Parent:
- 125:f58b7ab2abee
- Parent:
- 79:68f0dd8d1f19
- Child:
- 127:27c739fd6d71
attempt to restore default;
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
TickTock | 13:62e0f7f39ff5 | 1 | // main.cpp |
TickTock | 108:29b5a760adc2 | 2 | // |
TickTock | 4:8d7759f4fe7a | 3 | //To Do: |
TickTock | 33:a277743ebdeb | 4 | // * Audible friction brake feedback |
TickTock | 33:a277743ebdeb | 5 | // * User-configurable watchpoint |
TickTock | 33:a277743ebdeb | 6 | // * Add 50% charge option |
TickTock | 102:fd19f777a0b4 | 7 | // * Add coasting regen to regen/braking display |
TickTock | 103:1389e9efe8c3 | 8 | // * Change semilog efficiency graph to linear with 10 minute values |
TickTock | 102:fd19f777a0b4 | 9 | // * Add additional 79b bank readouts |
TickTock | 102:fd19f777a0b4 | 10 | // * Add ability to transfer settings config file to/from USB |
TickTock | 125:f58b7ab2abee | 11 | // * Subtract accessory power from efficiency history (add back in when displaying) |
TickTock | 13:62e0f7f39ff5 | 12 | |
TickTock | 12:8e42d7ba8468 | 13 | #include "mbed.h" |
TickTock | 12:8e42d7ba8468 | 14 | #include "CAN.h" |
TickTock | 12:8e42d7ba8468 | 15 | #include "beep.h" |
TickTock | 109:3e6f0e8fca0d | 16 | #include "ff.h" |
TickTock | 12:8e42d7ba8468 | 17 | #include "PowerControl.h" |
TickTock | 12:8e42d7ba8468 | 18 | #include "EthernetPowerControl.h" |
TickTock | 12:8e42d7ba8468 | 19 | #include "utility.h" |
TickTock | 12:8e42d7ba8468 | 20 | #include "displayModes.h" |
TickTock | 23:cd03f9c3395e | 21 | #include "TOUCH_TFTx2.h" |
TickTock | 4:8d7759f4fe7a | 22 | |
TickTock | 125:f58b7ab2abee | 23 | char revStr[7] = "125"; // gg - revision string, max 6 characters |
TickTock | 110:ffddff3ad2f2 | 24 | |
TickTock | 109:3e6f0e8fca0d | 25 | FATFS USBdrive; |
TickTock | 13:62e0f7f39ff5 | 26 | LocalFileSystem local("local"); |
TickTock | 109:3e6f0e8fca0d | 27 | bool waitasec = true; |
TickTock | 115:549410af477d | 28 | unsigned char wait5secs = 5; |
TickTock | 13:62e0f7f39ff5 | 29 | // to write to USB Flash Drives, or equivalent (SD card in Reader/Writer) |
TickTock | 119:0e2b641e98a2 | 30 | // class10 SDcard in Reader/Writer recommended |
TickTock | 111:d1559bb25c43 | 31 | FRESULT mfr = f_mount(0,&USBdrive); |
TickTock | 13:62e0f7f39ff5 | 32 | time_t seconds ; |
TickTock | 13:62e0f7f39ff5 | 33 | |
TickTock | 36:dbd39c315258 | 34 | Ticker autoPoll; |
TickTock | 36:dbd39c315258 | 35 | Ticker playback; |
TickTock | 78:a383971fe02f | 36 | Ticker msgReq; |
TickTock | 13:62e0f7f39ff5 | 37 | Timer timer; |
TickTock | 13:62e0f7f39ff5 | 38 | |
TickTock | 13:62e0f7f39ff5 | 39 | DigitalOut led1(LED1); |
TickTock | 13:62e0f7f39ff5 | 40 | DigitalOut led2(LED2); |
TickTock | 13:62e0f7f39ff5 | 41 | DigitalOut led3(LED3); |
TickTock | 13:62e0f7f39ff5 | 42 | DigitalOut led4(LED4); |
TickTock | 13:62e0f7f39ff5 | 43 | |
TickTock | 13:62e0f7f39ff5 | 44 | InterruptIn touchpad(p17); |
TickTock | 13:62e0f7f39ff5 | 45 | CAN can1(p9, p10); // CAN1 (EV) uses pins 9 and 10 (rx, tx) and pin 8 (rs) |
TickTock | 13:62e0f7f39ff5 | 46 | DigitalOut can1SleepMode(p8); // Use pin 8 to control the sleep mode of can2 |
TickTock | 13:62e0f7f39ff5 | 47 | CAN can2(p30, p29); // CAN2 (CAR) uses pins 30 and 29 (rx, tx) and pin 28 (rs) |
TickTock | 13:62e0f7f39ff5 | 48 | DigitalOut can2SleepMode(p28); // Use pin 28 to control the sleep mode of can1 |
TickTock | 35:5acbd8a64a89 | 49 | AnalogIn mon12V(p15); |
TickTock | 13:62e0f7f39ff5 | 50 | 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 | 51 | PwmOut dled(p23); |
TickTock | 35:5acbd8a64a89 | 52 | Beep spkr(p21); |
TickTock | 13:62e0f7f39ff5 | 53 | |
TickTock | 126:e0d039096891 | 54 | <<<<<<< local |
garygid | 87:46ac3f2519d6 | 55 | bool debugMode = false; |
TickTock | 108:29b5a760adc2 | 56 | bool usbEn = false; |
TickTock | 108:29b5a760adc2 | 57 | bool logEn = true; |
TickTock | 108:29b5a760adc2 | 58 | bool logOpen = false; |
TickTock | 115:549410af477d | 59 | bool yesBattLog = true; // gg - Batt Log |
TickTock | 108:29b5a760adc2 | 60 | unsigned char tNavRow = 3; // gg - 4x4 touch |
TickTock | 126:e0d039096891 | 61 | ======= |
garygid | 69:6bfdfc002036 | 62 | // revision string, max 6 characters |
garygid | 71:7e87256d6c9a | 63 | // gg - revStr is used in 2 places |
garygid | 71:7e87256d6c9a | 64 | // gg - and is easy to edit here |
garygid | 71:7e87256d6c9a | 65 | // gg - added ZeroSecTick and revStr |
TickTock | 79:68f0dd8d1f19 | 66 | char revStr[7] = "79"; |
TickTock | 126:e0d039096891 | 67 | >>>>>>> other |
garygid | 54:6ce808d0995e | 68 | |
TickTock | 109:3e6f0e8fca0d | 69 | FILE *hfile; // history file |
TickTock | 109:3e6f0e8fca0d | 70 | FIL efile; // external usb file |
TickTock | 109:3e6f0e8fca0d | 71 | FRESULT efr; // external file access flags |
TickTock | 109:3e6f0e8fca0d | 72 | unsigned int bytesRW; |
TickTock | 108:29b5a760adc2 | 73 | char fileName[35] = ""; |
TickTock | 84:fd21e5d32dab | 74 | char writeBuffer[maxBufLen][13] __attribute__ ((section("AHBSRAM1"))); // buffer for USB write |
TickTock | 13:62e0f7f39ff5 | 75 | char indexLastMsg[0x800]={0}; // index table for last message |
TickTock | 13:62e0f7f39ff5 | 76 | CANMessage lastMsg[100]; // table to store last message of eachtype |
garygid | 87:46ac3f2519d6 | 77 | |
TickTock | 124:0d622967b764 | 78 | unsigned char battData[BatDataBufMax]={0}; // 7 * 0x3D = BatDataBufMax |
garygid | 87:46ac3f2519d6 | 79 | |
TickTock | 13:62e0f7f39ff5 | 80 | unsigned char msgChanged[100]; // inidcates which bytes changed |
TickTock | 13:62e0f7f39ff5 | 81 | char c; |
TickTock | 76:fb6779d0963e | 82 | volatile int writePointer = 0; |
TickTock | 76:fb6779d0963e | 83 | int readPointer=0; |
TickTock | 75:77bd26829dca | 84 | volatile unsigned short secsNoMsg = 0; |
TickTock | 75:77bd26829dca | 85 | volatile unsigned short secsNoTouch = 0; |
TickTock | 20:3bf176d14b14 | 86 | volatile bool canIdle; |
TickTock | 20:3bf176d14b14 | 87 | volatile bool userIdle; |
TickTock | 26:462ccb580472 | 88 | bool touched=false; //flag to read touchscreen |
TickTock | 42:4533b13b297d | 89 | unsigned char whichTouched = 0; |
TickTock | 13:62e0f7f39ff5 | 90 | char counter = 0; |
TickTock | 41:8d4609ea7259 | 91 | unsigned char dMode[2] = {mainScreen,brakeScreen}; //display mode |
TickTock | 13:62e0f7f39ff5 | 92 | unsigned char sMode = 0; // setup mode |
TickTock | 13:62e0f7f39ff5 | 93 | unsigned char lastDMode[2] = {0,0}; //last screen mode |
TickTock | 25:ddf0ec209f03 | 94 | unsigned char dtMode = 6; |
TickTock | 13:62e0f7f39ff5 | 95 | char displayLog[20][40]; |
TickTock | 13:62e0f7f39ff5 | 96 | unsigned char displayLoc = 0; |
leafman | 98:9f8bab96edff | 97 | unsigned int fwCount=1; |
TickTock | 13:62e0f7f39ff5 | 98 | unsigned char indexOffset = 1; |
TickTock | 13:62e0f7f39ff5 | 99 | bool showCP = false; |
TickTock | 39:eef8beac7411 | 100 | bool logCP = false; //Turbo3 |
TickTock | 108:29b5a760adc2 | 101 | bool logOnce = false; |
TickTock | 103:1389e9efe8c3 | 102 | bool repeatPoll = true; |
TickTock | 34:4751a8259b18 | 103 | bool headlights = false; |
TickTock | 34:4751a8259b18 | 104 | bool tick = false; |
garygid | 69:6bfdfc002036 | 105 | bool ZeroSecTick = false; |
TickTock | 35:5acbd8a64a89 | 106 | float ledHi = 0.8; // Bright LED value (until config file read) |
TickTock | 35:5acbd8a64a89 | 107 | float ledLo = 0.1; // Dim LED value (until config file read) |
TickTock | 35:5acbd8a64a89 | 108 | unsigned short pollInt = 300; // polling interval=5 minutes (until config file read) |
TickTock | 35:5acbd8a64a89 | 109 | bool accOn = false; // Accessories on |
TickTock | 49:a3d2c5bb3cfa | 110 | bool laccOn = false; |
TickTock | 35:5acbd8a64a89 | 111 | float scale12V = 16.2; // R1:R2 ratio |
TickTock | 40:0e6e71a7323f | 112 | signed long mWs_x4 = 0; |
TickTock | 40:0e6e71a7323f | 113 | unsigned short numWsamples = 0; |
TickTock | 41:8d4609ea7259 | 114 | unsigned short numSsamples = 0; |
TickTock | 35:5acbd8a64a89 | 115 | float accV = 0; |
TickTock | 36:dbd39c315258 | 116 | bool playbackEn = false; |
TickTock | 36:dbd39c315258 | 117 | bool playbackOpen = false; |
TickTock | 49:a3d2c5bb3cfa | 118 | //float playbackInt = 0.05; //read messages every 50 ms |
TickTock | 78:a383971fe02f | 119 | float playbackInt = 0.005; //read messages every 5 ms |
TickTock | 36:dbd39c315258 | 120 | bool step = false; |
TickTock | 37:fea2c1d52c5f | 121 | char header[5]; |
TickTock | 36:dbd39c315258 | 122 | char data[8]; |
TickTock | 41:8d4609ea7259 | 123 | signed long motorRPM; |
garygid | 65:821fc79cd7fe | 124 | unsigned char skin = ttSkin ; |
TickTock | 50:83d5864c64a0 | 125 | unsigned char dtePeriod = 14; //ten minute averaging interval |
TickTock | 107:e9be732c1ad4 | 126 | float kWh_trip[3]={0}; |
TickTock | 107:e9be732c1ad4 | 127 | float miles_trip[3]={0}; |
TickTock | 49:a3d2c5bb3cfa | 128 | float mph[39]={0}; |
TickTock | 49:a3d2c5bb3cfa | 129 | float kW[39]={0}; |
TickTock | 49:a3d2c5bb3cfa | 130 | float mpkWh[39]={0}; |
TickTock | 120:041edeec08f5 | 131 | float unloadedV_x2,Resr,curRmax,curRmin,redRmax,redRmin,incRmax,incRmin; |
TickTock | 121:553faf139a20 | 132 | signed short Imax, Imin; |
TickTock | 49:a3d2c5bb3cfa | 133 | // Logarithmic division scale (roughly - snapped to common units of time) |
TickTock | 49:a3d2c5bb3cfa | 134 | float timeConstant[39] = {1, 1.58, 2.51, 3.98, 6.31, 10, 15.8, 25.1, 39.8, 60, // 1 minute |
TickTock | 52:d5385fbf4ea1 | 135 | 60*1.58, 60*2.51, 60*3.98, 60*6.31, 60*10, 60*15.8, 60*25.1, 60*39.8, 60*60, // 1 hour |
TickTock | 52:d5385fbf4ea1 | 136 | 60*60*1.58, 60*60*2.51, 60*60*3.98, 60*60*6.31, 60*60*10, 60*60*15.8, 60*60*24, // 1 day |
TickTock | 52:d5385fbf4ea1 | 137 | 60*60*24*1.58, 60*60*24*2.51, 60*60*24*3.98, 60*60*24*6.31, 60*60*24*10, 60*60*24*15.8, 60*60*24*30, // 1 month |
TickTock | 52:d5385fbf4ea1 | 138 | 60*60*24*39.8, 60*60*24*63.1, 60*60*24*100, 60*60*24*158, 60*60*24*251, 60*60*24*365}; // 1 year |
TickTock | 121:553faf139a20 | 139 | bool tock = false; |
TickTock | 73:62ee8eae3a84 | 140 | unsigned short pointerSep; |
TickTock | 78:a383971fe02f | 141 | unsigned char reqMsgCnt = 99; |
TickTock | 102:fd19f777a0b4 | 142 | unsigned long Ah_x10000 = 0; |
TickTock | 102:fd19f777a0b4 | 143 | unsigned long SOC_x10000 = 0; |
TickTock | 102:fd19f777a0b4 | 144 | unsigned short SOH_x100 = 0; |
TickTock | 108:29b5a760adc2 | 145 | float maxTemp = 0; |
leafman | 98:9f8bab96edff | 146 | bool metric = false; |
TickTock | 121:553faf139a20 | 147 | bool shunt[96]={0}; |
TickTock | 121:553faf139a20 | 148 | bool charging=false; |
TickTock | 13:62e0f7f39ff5 | 149 | |
TickTock | 0:1596b8644523 | 150 | int main() { |
TickTock | 120:041edeec08f5 | 151 | //can1SleepMode.mode(OpenDrain); |
TickTock | 120:041edeec08f5 | 152 | //can2SleepMode.mode(OpenDrain); |
TickTock | 4:8d7759f4fe7a | 153 | char sTemp[40]; |
TickTock | 2:71b1999a8ea5 | 154 | unsigned long secs; |
TickTock | 49:a3d2c5bb3cfa | 155 | unsigned char i,j,display=0,lwt=0; |
TickTock | 22:a43df3905863 | 156 | point lastTouch; |
TickTock | 52:d5385fbf4ea1 | 157 | float average; |
TickTock | 3:3e879b043bc5 | 158 | tt.set_orientation(1); |
TickTock | 4:8d7759f4fe7a | 159 | tt.background(Black); |
TickTock | 19:d576298c46f3 | 160 | tt.set_display(2); // select both displays |
TickTock | 3:3e879b043bc5 | 161 | tt.cls(); |
TickTock | 1:9dcd70c32180 | 162 | tt.claim(stdout); // send stdout to the TFT display |
TickTock | 12:8e42d7ba8468 | 163 | touchpad.rise(&touch_ISR); |
TickTock | 4:8d7759f4fe7a | 164 | tt.wfi(); // enable interrupt on touch |
TickTock | 7:17bf9ceaf0aa | 165 | dled = 0.8; // turn on display LED 80% |
TickTock | 120:041edeec08f5 | 166 | Resr = 0.075; // initial guess of Resr |
TickTock | 2:71b1999a8ea5 | 167 | timer.start() ; |
TickTock | 2:71b1999a8ea5 | 168 | RTC_Init(); // start the RTC Interrupts that sync the timer |
TickTock | 1:9dcd70c32180 | 169 | struct tm t; // pointer to a static tm structure |
TickTock | 93:c2402e8cd0e2 | 170 | NVIC_SetPriority(CAN_IRQn, 2); //set can priority just below RTC |
TickTock | 117:49883c779a74 | 171 | NVIC_SetPriority(TIMER3_IRQn, 3); //set ticker priority just below can |
TickTock | 33:a277743ebdeb | 172 | |
TickTock | 1:9dcd70c32180 | 173 | seconds = time(NULL); |
TickTock | 1:9dcd70c32180 | 174 | t = *localtime(&seconds) ; |
TickTock | 1:9dcd70c32180 | 175 | // is it a date before 2012 ? |
TickTock | 26:462ccb580472 | 176 | if ((t.tm_year + 1900) < 2012 ) { |
TickTock | 26:462ccb580472 | 177 | // before 2013 so update year to make date entry easier |
TickTock | 26:462ccb580472 | 178 | t.tm_year = 2013 - 1900; |
TickTock | 1:9dcd70c32180 | 179 | // set the RTC |
TickTock | 1:9dcd70c32180 | 180 | set_time(mktime(&t)); |
TickTock | 1:9dcd70c32180 | 181 | seconds = time(NULL); |
TickTock | 26:462ccb580472 | 182 | } |
TickTock | 20:3bf176d14b14 | 183 | t = *localtime(&seconds) ; |
TickTock | 20:3bf176d14b14 | 184 | strftime(sTemp, 32, "%a %m/%d/%Y %X\n", &t); |
TickTock | 93:c2402e8cd0e2 | 185 | printMsg(sTemp); // record RTC |
garygid | 54:6ce808d0995e | 186 | |
TickTock | 62:ffd15edb5431 | 187 | // revision |
garygid | 70:0700b769ac15 | 188 | sprintf(sTemp,"CANary firmware rev%s\n", revStr); // gg - for Logging the revision |
TickTock | 93:c2402e8cd0e2 | 189 | printMsg(sTemp); // revision |
TickTock | 17:e32324a2678d | 190 | |
TickTock | 26:462ccb580472 | 191 | secsNoMsg = 0; |
TickTock | 43:e7f6f80590e3 | 192 | |
TickTock | 49:a3d2c5bb3cfa | 193 | //read efficiency history data |
TickTock | 97:a25940fd7b5b | 194 | hfile = fopen("/local/ehist.cny", "r"); |
TickTock | 97:a25940fd7b5b | 195 | if (hfile!=NULL){ // found a efficiency history file |
TickTock | 49:a3d2c5bb3cfa | 196 | for(i=0;i<39;i++){ |
TickTock | 97:a25940fd7b5b | 197 | if(!feof(hfile)){ |
TickTock | 97:a25940fd7b5b | 198 | fscanf(hfile,"%f %f\r\n",&mph[i],&kW[i]); |
TickTock | 49:a3d2c5bb3cfa | 199 | mpkWh[i]=mph[i]/kW[i]; |
TickTock | 49:a3d2c5bb3cfa | 200 | } |
TickTock | 49:a3d2c5bb3cfa | 201 | } |
TickTock | 97:a25940fd7b5b | 202 | fclose(hfile); |
TickTock | 116:5cd72bae7c12 | 203 | printMsg("History Loaded.\n"); // History loaded |
TickTock | 49:a3d2c5bb3cfa | 204 | } else { // create initial file |
TickTock | 116:5cd72bae7c12 | 205 | printMsg("History not found. Created.\n"); // history not found, created |
TickTock | 49:a3d2c5bb3cfa | 206 | for(i=0;i<39;i++){ |
TickTock | 49:a3d2c5bb3cfa | 207 | // Pre-load with 4 mpkWh @ 40 mph |
TickTock | 49:a3d2c5bb3cfa | 208 | mph[i]=40*timeConstant[i]; |
TickTock | 49:a3d2c5bb3cfa | 209 | kW[i]=10*timeConstant[i]; |
TickTock | 49:a3d2c5bb3cfa | 210 | mpkWh[i]=4; |
TickTock | 49:a3d2c5bb3cfa | 211 | } |
TickTock | 49:a3d2c5bb3cfa | 212 | } |
TickTock | 49:a3d2c5bb3cfa | 213 | |
TickTock | 46:73e8716f976f | 214 | // Read config file |
TickTock | 46:73e8716f976f | 215 | readConfig(); |
TickTock | 126:e0d039096891 | 216 | <<<<<<< local |
TickTock | 108:29b5a760adc2 | 217 | if (repeatPoll) { // enable autopolling if enabled |
TickTock | 108:29b5a760adc2 | 218 | autoPoll.attach(&autoPollISR,pollInt); |
TickTock | 108:29b5a760adc2 | 219 | } |
TickTock | 108:29b5a760adc2 | 220 | |
TickTock | 126:e0d039096891 | 221 | ======= |
TickTock | 43:e7f6f80590e3 | 222 | |
TickTock | 78:a383971fe02f | 223 | // Start 15ms timer for requests |
TickTock | 79:68f0dd8d1f19 | 224 | //msgReq.attach(&sendReq,0.015); |
TickTock | 78:a383971fe02f | 225 | |
TickTock | 126:e0d039096891 | 226 | >>>>>>> other |
TickTock | 77:7c136766466c | 227 | // Start monitors |
TickTock | 77:7c136766466c | 228 | can1.monitor(true); // set to snoop mode |
TickTock | 77:7c136766466c | 229 | can2.monitor(true); // set to snoop mode |
TickTock | 77:7c136766466c | 230 | can1.frequency(500000); |
TickTock | 77:7c136766466c | 231 | can2.frequency(500000); |
TickTock | 120:041edeec08f5 | 232 | can1SleepMode = VP230Sleep; // Turn on Monitor_only Mode |
TickTock | 120:041edeec08f5 | 233 | can2SleepMode = VP230Sleep; // Turn on Monitor_only Mode |
TickTock | 77:7c136766466c | 234 | can1.attach(&recieve1); |
TickTock | 77:7c136766466c | 235 | can2.attach(&recieve2); |
TickTock | 77:7c136766466c | 236 | |
TickTock | 26:462ccb580472 | 237 | touched=false; |
TickTock | 26:462ccb580472 | 238 | secsNoTouch=2; |
TickTock | 2:71b1999a8ea5 | 239 | while (true) { |
TickTock | 4:8d7759f4fe7a | 240 | if (!logOpen) { // Open new file if one is not already open |
TickTock | 112:b41b35401eb6 | 241 | if(logEn&&usbEn){ //logging enables and USB device detected |
TickTock | 109:3e6f0e8fca0d | 242 | strftime(fileName, 32, "%m%d%H%M.alc", &t); //mmddhhmm.alc |
TickTock | 109:3e6f0e8fca0d | 243 | efr = f_open(&efile,fileName,FA_WRITE|FA_OPEN_ALWAYS); |
TickTock | 7:17bf9ceaf0aa | 244 | seconds = time(NULL); |
TickTock | 7:17bf9ceaf0aa | 245 | t = *localtime(&seconds) ; |
TickTock | 94:c3a14b3975d6 | 246 | lastDMode[0]=99;//force refresh |
TickTock | 94:c3a14b3975d6 | 247 | lastDMode[1]=99;//force refresh |
TickTock | 109:3e6f0e8fca0d | 248 | if(efr != FR_OK){ |
TickTock | 109:3e6f0e8fca0d | 249 | sprintf(sTemp,"\nERR:%d Unable to open %s\n\n\n\n",efr,fileName); |
TickTock | 93:c2402e8cd0e2 | 250 | printMsg(sTemp); // cannot open alc file |
TickTock | 7:17bf9ceaf0aa | 251 | logEn=false; |
TickTock | 26:462ccb580472 | 252 | spkr.beep(1000,0.25); |
TickTock | 109:3e6f0e8fca0d | 253 | wait_ms(500); |
TickTock | 109:3e6f0e8fca0d | 254 | spkr.beep(1000,0.25); |
TickTock | 7:17bf9ceaf0aa | 255 | } else { |
TickTock | 7:17bf9ceaf0aa | 256 | logOpen = true; |
TickTock | 7:17bf9ceaf0aa | 257 | readPointer=writePointer; |
TickTock | 7:17bf9ceaf0aa | 258 | sprintf(sTemp,"Starting Can Log %s\n",fileName); |
TickTock | 93:c2402e8cd0e2 | 259 | printMsg(sTemp); // starting alc log file |
garygid | 69:6bfdfc002036 | 260 | |
garygid | 69:6bfdfc002036 | 261 | logTS(); // Date Time at start |
TickTock | 93:c2402e8cd0e2 | 262 | logEvent("Starting"); // Log startup msg for testing |
garygid | 69:6bfdfc002036 | 263 | sprintf(sTemp,"Cr%s",revStr); |
TickTock | 108:29b5a760adc2 | 264 | logEvent(sTemp); // gg - log firmware version |
TickTock | 26:462ccb580472 | 265 | spkr.beep(2000,0.25); |
TickTock | 7:17bf9ceaf0aa | 266 | } |
TickTock | 108:29b5a760adc2 | 267 | }//logging enabled and USB detected |
TickTock | 15:a359fecf85ba | 268 | } else { // if (logOpen) |
TickTock | 73:62ee8eae3a84 | 269 | pointerSep=(writePointer+maxBufLen-readPointer)%maxBufLen; |
TickTock | 73:62ee8eae3a84 | 270 | if (pointerSep>(maxBufLen/16)||canIdle||!logEn) { |
TickTock | 7:17bf9ceaf0aa | 271 | // Dump buffer if > 1/16 full or canbus has stopped |
TickTock | 117:49883c779a74 | 272 | //if (&efile == NULL) { |
TickTock | 117:49883c779a74 | 273 | if (efr != FR_OK) { |
TickTock | 7:17bf9ceaf0aa | 274 | logOpen = false; |
TickTock | 117:49883c779a74 | 275 | printMsg("Failed to append log file.\n"); // failed to append |
TickTock | 117:49883c779a74 | 276 | spkr.beep(3000,0.25); |
TickTock | 117:49883c779a74 | 277 | spkr.beep(1500,0.25); |
TickTock | 117:49883c779a74 | 278 | spkr.beep(750,0.25); |
TickTock | 117:49883c779a74 | 279 | spkr.beep(375,0.25); |
TickTock | 7:17bf9ceaf0aa | 280 | logEn=false; |
TickTock | 7:17bf9ceaf0aa | 281 | } else { |
TickTock | 7:17bf9ceaf0aa | 282 | while (readPointer != writePointer) { |
TickTock | 117:49883c779a74 | 283 | efr=f_write(&efile,&writeBuffer[readPointer][0],13,&bytesRW); |
TickTock | 117:49883c779a74 | 284 | if(++readPointer >= maxBufLen){ |
TickTock | 117:49883c779a74 | 285 | readPointer=0; |
TickTock | 117:49883c779a74 | 286 | led4 = !led4; |
TickTock | 4:8d7759f4fe7a | 287 | } |
TickTock | 4:8d7759f4fe7a | 288 | } |
TickTock | 7:17bf9ceaf0aa | 289 | } |
TickTock | 30:e633a63eb257 | 290 | } // if > 1/16 full, canbus has stopped, or logging stopped |
TickTock | 30:e633a63eb257 | 291 | if (!logEn) { |
TickTock | 77:7c136766466c | 292 | sprintf(sTemp,"Stopping Can Log %s\n",fileName); |
TickTock | 93:c2402e8cd0e2 | 293 | printMsg(sTemp); // stopping alc log file |
TickTock | 109:3e6f0e8fca0d | 294 | f_close(&efile); |
TickTock | 30:e633a63eb257 | 295 | logOpen=false; |
TickTock | 77:7c136766466c | 296 | pointerSep=0; |
TickTock | 108:29b5a760adc2 | 297 | led4=false; |
TickTock | 30:e633a63eb257 | 298 | } |
TickTock | 4:8d7759f4fe7a | 299 | } // if logOpen |
TickTock | 36:dbd39c315258 | 300 | if (canIdle&&userIdle&&!playbackEn) { // canbus idle --> sleep to save power |
TickTock | 95:248b3c25a7df | 301 | if (repeatPoll) { // stop autopolling if enabled |
TickTock | 95:248b3c25a7df | 302 | autoPoll.detach(); |
TickTock | 95:248b3c25a7df | 303 | } |
TickTock | 111:d1559bb25c43 | 304 | if (logOpen){ //close file to dump buffer |
TickTock | 111:d1559bb25c43 | 305 | f_close(&efile); |
TickTock | 111:d1559bb25c43 | 306 | } // if (logOpen) |
TickTock | 20:3bf176d14b14 | 307 | seconds = time(NULL); |
TickTock | 20:3bf176d14b14 | 308 | t = *localtime(&seconds) ; |
TickTock | 21:22bdce9efcb5 | 309 | strftime(sTemp, 40, "Sleeping: %a %m/%d/%Y %X\n", &t); |
TickTock | 93:c2402e8cd0e2 | 310 | printMsg(sTemp); // sleeping date time |
TickTock | 25:ddf0ec209f03 | 311 | updateDisplay(0); //Added for turbo3 who has a display override and wants to see the sleep message before going to sleep |
TickTock | 25:ddf0ec209f03 | 312 | updateDisplay(1); |
TickTock | 4:8d7759f4fe7a | 313 | //LPC_RTC->CIIR=0x00; // block RTC interrupts |
TickTock | 4:8d7759f4fe7a | 314 | led1=0; |
TickTock | 4:8d7759f4fe7a | 315 | led2=0; |
TickTock | 4:8d7759f4fe7a | 316 | led3=0; |
TickTock | 4:8d7759f4fe7a | 317 | led4=0; |
TickTock | 4:8d7759f4fe7a | 318 | dled=0; // turn off display |
TickTock | 4:8d7759f4fe7a | 319 | secs = time(NULL); // seconds past 12:00:00 AM 1 Jan 1900 |
TickTock | 22:a43df3905863 | 320 | while (secsNoMsg>canTimeout && !touched) { |
TickTock | 4:8d7759f4fe7a | 321 | //DeepPowerDown(); |
TickTock | 12:8e42d7ba8468 | 322 | tt.wfi(); //enable touch interrupt |
TickTock | 21:22bdce9efcb5 | 323 | //__wfi(); // freeze CPU and wait for interrupt (from canbus or touch) |
TickTock | 21:22bdce9efcb5 | 324 | Sleep(); |
TickTock | 4:8d7759f4fe7a | 325 | } |
TickTock | 97:a25940fd7b5b | 326 | lastDMode[0]=99; |
TickTock | 97:a25940fd7b5b | 327 | lastDMode[1]=99; |
TickTock | 43:e7f6f80590e3 | 328 | secsNoTouch=2; |
TickTock | 4:8d7759f4fe7a | 329 | canIdle=secsNoMsg>canTimeout; |
TickTock | 7:17bf9ceaf0aa | 330 | dled=0.8; // turn on display LED |
TickTock | 20:3bf176d14b14 | 331 | seconds = time(NULL); |
TickTock | 20:3bf176d14b14 | 332 | t = *localtime(&seconds) ; |
TickTock | 21:22bdce9efcb5 | 333 | strftime(sTemp, 40, "Waking: %a %m/%d/%Y %X\n", &t); |
TickTock | 93:c2402e8cd0e2 | 334 | printMsg(sTemp); // wakeup date time |
TickTock | 4:8d7759f4fe7a | 335 | if (time(NULL)>(secs+1800)) { |
TickTock | 110:ffddff3ad2f2 | 336 | if (logOpen){ |
TickTock | 110:ffddff3ad2f2 | 337 | f_close(&efile); |
TickTock | 110:ffddff3ad2f2 | 338 | logOpen = false; // Start new file if asleep for more than 30 minutes |
TickTock | 110:ffddff3ad2f2 | 339 | } // if (logOpen) |
TickTock | 4:8d7759f4fe7a | 340 | if (secsNoTouch>100) secsNoTouch = 100; // also mostly reset user Idle counter |
TickTock | 43:e7f6f80590e3 | 341 | } else if (logOpen){ // insert timestamp on each wake if logging enabled (disabled for now) |
TickTock | 111:d1559bb25c43 | 342 | efr = f_open(&efile,fileName,FA_WRITE|FA_OPEN_ALWAYS); |
TickTock | 111:d1559bb25c43 | 343 | f_lseek(&efile,0xffffffff); // goto end of file (append existing) |
TickTock | 93:c2402e8cd0e2 | 344 | logEvent("WakingUp"); // gg - use messeges |
garygid | 69:6bfdfc002036 | 345 | logTS(); // Date-Time at wakeup |
TickTock | 4:8d7759f4fe7a | 346 | } |
TickTock | 95:248b3c25a7df | 347 | if (repeatPoll) { // re-enable autopolling if enabled |
TickTock | 124:0d622967b764 | 348 | autoPoll.attach(&autoPollISR,pollInt); |
TickTock | 95:248b3c25a7df | 349 | } |
TickTock | 4:8d7759f4fe7a | 350 | } // if idle |
TickTock | 4:8d7759f4fe7a | 351 | |
TickTock | 15:a359fecf85ba | 352 | if(touched){ // call touchscreen procedure if touch interrupt detected |
TickTock | 7:17bf9ceaf0aa | 353 | lastTouch = tt.get_touch(); |
TickTock | 7:17bf9ceaf0aa | 354 | lastTouch = tt.to_pixel(lastTouch); // convert to pixel pos |
TickTock | 40:0e6e71a7323f | 355 | if((lastTouch.x!=639)&&(lastTouch.x!=319)&&(lastTouch.y!=239)){ // filter phantom touches |
TickTock | 43:e7f6f80590e3 | 356 | if (userIdle) { |
TickTock | 43:e7f6f80590e3 | 357 | secsNoTouch=2; // Ignore first touch if user idle |
TickTock | 43:e7f6f80590e3 | 358 | userIdle=false; |
TickTock | 40:0e6e71a7323f | 359 | } else { |
TickTock | 43:e7f6f80590e3 | 360 | secsNoTouch=0; |
TickTock | 40:0e6e71a7323f | 361 | } |
TickTock | 43:e7f6f80590e3 | 362 | if (lastTouch.x>320){ |
TickTock | 43:e7f6f80590e3 | 363 | whichTouched=1; |
TickTock | 43:e7f6f80590e3 | 364 | } else { |
TickTock | 43:e7f6f80590e3 | 365 | whichTouched=0; |
TickTock | 43:e7f6f80590e3 | 366 | } |
TickTock | 43:e7f6f80590e3 | 367 | if (whichTouched!=lwt){ |
TickTock | 43:e7f6f80590e3 | 368 | lastDMode[lwt]=99; // Repaint lastTouched |
TickTock | 43:e7f6f80590e3 | 369 | lwt=whichTouched; |
TickTock | 43:e7f6f80590e3 | 370 | } |
TickTock | 43:e7f6f80590e3 | 371 | sMode = 1; |
TickTock | 22:a43df3905863 | 372 | } |
TickTock | 22:a43df3905863 | 373 | //sprintf(sTemp,"%d,%d ",lastTouch.x,lastTouch.y); |
TickTock | 93:c2402e8cd0e2 | 374 | //printMsg(sTemp); // touch x,y - for debug |
TickTock | 12:8e42d7ba8468 | 375 | touched = false; // clear interrupt flag |
TickTock | 7:17bf9ceaf0aa | 376 | } |
garygid | 54:6ce808d0995e | 377 | //--------------- |
garygid | 54:6ce808d0995e | 378 | // gg - 4x4 touch |
TickTock | 62:ffd15edb5431 | 379 | //unsigned char tScrn = 0 ; // screen 0 |
garygid | 54:6ce808d0995e | 380 | unsigned char tCol ; |
garygid | 54:6ce808d0995e | 381 | unsigned char tRow ; |
garygid | 54:6ce808d0995e | 382 | |
TickTock | 4:8d7759f4fe7a | 383 | if (!userIdle) { |
TickTock | 4:8d7759f4fe7a | 384 | if (secsNoTouch<2) {// Recently touched |
TickTock | 4:8d7759f4fe7a | 385 | secsNoTouch +=2; // increment to prevent double touch |
TickTock | 43:e7f6f80590e3 | 386 | sMode = 1; |
TickTock | 22:a43df3905863 | 387 | //sprintf(sTemp,"button %d %d,%d %d\n",i,buttonX(lastTouch.x,3),buttonY(lastTouch.y,3),lastTouch.x); |
TickTock | 93:c2402e8cd0e2 | 388 | //printMsg(sTemp); // button parms - for debug |
TickTock | 23:cd03f9c3395e | 389 | switch (sMode) { |
TickTock | 23:cd03f9c3395e | 390 | case 0: // no select |
TickTock | 23:cd03f9c3395e | 391 | break; |
TickTock | 63:aa3bf6a33635 | 392 | case 1: // select screen |
garygid | 54:6ce808d0995e | 393 | //-------------- |
garygid | 54:6ce808d0995e | 394 | // gg - 4x4 touch |
garygid | 54:6ce808d0995e | 395 | tCol = buttonX(lastTouch.x,4) ; |
TickTock | 62:ffd15edb5431 | 396 | if( tCol >= 4 ){ tCol -= 4; } // touch is on screen 1 |
garygid | 54:6ce808d0995e | 397 | |
garygid | 54:6ce808d0995e | 398 | tRow = buttonY(lastTouch.y,4) ; |
garygid | 54:6ce808d0995e | 399 | |
TickTock | 63:aa3bf6a33635 | 400 | highlightButton( tCol,tRow, whichTouched, 4,4) ; // gg - highlight |
garygid | 58:4d06288d75a2 | 401 | |
TickTock | 63:aa3bf6a33635 | 402 | if( tRow == tNavRow ) tRow = 7 ; // gg |
garygid | 54:6ce808d0995e | 403 | switch ( (tCol*10) + tRow ) { |
garygid | 54:6ce808d0995e | 404 | //--------------------------------- |
garygid | 67:2022fce701d0 | 405 | case 00: // top row, left button on screen 0 or 1 |
TickTock | 42:4533b13b297d | 406 | if (dMode[whichTouched]==monitorScreen||dMode[whichTouched]==changedScreen) { |
garygid | 67:2022fce701d0 | 407 | indexOffset=indexOffset>4?indexOffset-4:1; |
garygid | 67:2022fce701d0 | 408 | } else if (dMode[whichTouched] == indexScreen) { // gg - index |
garygid | 67:2022fce701d0 | 409 | dMode[whichTouched] = mainScreen ; // GoTo Main Screen |
TickTock | 73:62ee8eae3a84 | 410 | sMode=0; |
leafman | 98:9f8bab96edff | 411 | } else if (dMode[whichTouched]==configScreen) { |
TickTock | 23:cd03f9c3395e | 412 | wait_ms(500); |
TickTock | 37:fea2c1d52c5f | 413 | tt.background(Black); |
TickTock | 23:cd03f9c3395e | 414 | tt.calibrate(); |
TickTock | 42:4533b13b297d | 415 | } else if (dMode[whichTouched]==playbackScreen) { // slower |
TickTock | 36:dbd39c315258 | 416 | playbackInt *=2; |
TickTock | 36:dbd39c315258 | 417 | if(playbackEn){ |
TickTock | 36:dbd39c315258 | 418 | playback.detach(); |
TickTock | 36:dbd39c315258 | 419 | playback.attach(&playbackISR,playbackInt); |
TickTock | 36:dbd39c315258 | 420 | } |
TickTock | 62:ffd15edb5431 | 421 | } else { |
TickTock | 62:ffd15edb5431 | 422 | lastDMode[whichTouched]=99;//repaint to clear highlight |
TickTock | 23:cd03f9c3395e | 423 | } |
TickTock | 23:cd03f9c3395e | 424 | break; |
garygid | 54:6ce808d0995e | 425 | //----------------------------------------------- |
garygid | 67:2022fce701d0 | 426 | case 10: // 1,0 (col left of center,top row) on screen 0 or 1 |
TickTock | 42:4533b13b297d | 427 | if (dMode[whichTouched]==changedScreen) { |
TickTock | 23:cd03f9c3395e | 428 | for(j=0;j<100;j++) msgChanged[j]=0; // clear changed data |
TickTock | 42:4533b13b297d | 429 | lastDMode[whichTouched]=99;//force refresh |
garygid | 67:2022fce701d0 | 430 | } else if (dMode[whichTouched] == indexScreen) { // gg - index |
TickTock | 73:62ee8eae3a84 | 431 | sMode=0; |
garygid | 67:2022fce701d0 | 432 | dMode[whichTouched] = brakeScreen ; // GoTo Brake Screen |
TickTock | 42:4533b13b297d | 433 | } else if (dMode[whichTouched]==cpScreen) { |
TickTock | 78:a383971fe02f | 434 | reqMsgCnt=0; |
TickTock | 79:68f0dd8d1f19 | 435 | msgReq.attach(&sendReq,0.015); |
TickTock | 48:d1ce92104a1f | 436 | } else if (dMode[whichTouched]==cpHistScreen) { // gg - hist |
TickTock | 78:a383971fe02f | 437 | reqMsgCnt=0; |
TickTock | 79:68f0dd8d1f19 | 438 | msgReq.attach(&sendReq,0.015); |
TickTock | 48:d1ce92104a1f | 439 | } else if (dMode[whichTouched]==cpBarScreen) { // gg - cpbars |
TickTock | 78:a383971fe02f | 440 | reqMsgCnt=0; |
TickTock | 79:68f0dd8d1f19 | 441 | msgReq.attach(&sendReq,0.015); |
TickTock | 126:e0d039096891 | 442 | <<<<<<< local |
leafman | 98:9f8bab96edff | 443 | } else if (dMode[whichTouched]==configScreen) { |
TickTock | 126:e0d039096891 | 444 | ======= |
TickTock | 42:4533b13b297d | 445 | } else if (dMode[whichTouched]==config1Screen) { |
TickTock | 126:e0d039096891 | 446 | >>>>>>> other |
TickTock | 23:cd03f9c3395e | 447 | mbed_reset(); |
TickTock | 42:4533b13b297d | 448 | } else if (dMode[whichTouched]==playbackScreen) { // pause/unpause |
TickTock | 36:dbd39c315258 | 449 | playbackEn=!playbackEn; |
TickTock | 36:dbd39c315258 | 450 | if(playbackEn){ |
TickTock | 36:dbd39c315258 | 451 | playback.attach(&playbackISR,playbackInt); |
TickTock | 62:ffd15edb5431 | 452 | } else { |
TickTock | 36:dbd39c315258 | 453 | playback.detach(); |
TickTock | 36:dbd39c315258 | 454 | } |
TickTock | 62:ffd15edb5431 | 455 | } else { |
TickTock | 62:ffd15edb5431 | 456 | lastDMode[whichTouched]=99;//repaint to clear highlight |
TickTock | 23:cd03f9c3395e | 457 | } |
TickTock | 62:ffd15edb5431 | 458 | |
TickTock | 23:cd03f9c3395e | 459 | break; |
garygid | 54:6ce808d0995e | 460 | //-------------------------------------- |
garygid | 54:6ce808d0995e | 461 | case 20: // col 2 and row 0 on either screen 0 or 1 |
TickTock | 42:4533b13b297d | 462 | if (dMode[whichTouched]==monitorScreen||dMode[whichTouched]==changedScreen) { |
TickTock | 23:cd03f9c3395e | 463 | indexOffset=indexOffset<77?indexOffset+4:80; |
garygid | 67:2022fce701d0 | 464 | } else if (dMode[whichTouched] == indexScreen) { // gg - index |
garygid | 67:2022fce701d0 | 465 | dMode[whichTouched] = effScreen ; // GoTo EFF Screen |
TickTock | 73:62ee8eae3a84 | 466 | sMode=0; |
leafman | 98:9f8bab96edff | 467 | } else if (dMode[whichTouched]==configScreen) { |
TickTock | 116:5cd72bae7c12 | 468 | printMsg("Saving config file.\n"); // saving config |
TickTock | 25:ddf0ec209f03 | 469 | saveConfig(); |
TickTock | 26:462ccb580472 | 470 | spkr.beep(2000,0.25); |
TickTock | 42:4533b13b297d | 471 | } else if (dMode[whichTouched]==playbackScreen) { // faster |
TickTock | 36:dbd39c315258 | 472 | if(playbackInt>.002){ |
TickTock | 36:dbd39c315258 | 473 | playbackInt/=2; |
TickTock | 36:dbd39c315258 | 474 | if(playbackEn){ |
TickTock | 36:dbd39c315258 | 475 | playback.detach(); |
TickTock | 36:dbd39c315258 | 476 | playback.attach(&playbackISR,playbackInt); |
TickTock | 36:dbd39c315258 | 477 | } |
TickTock | 36:dbd39c315258 | 478 | } |
TickTock | 86:d1c9e8ac1c4b | 479 | } else { |
TickTock | 62:ffd15edb5431 | 480 | lastDMode[whichTouched]=99;//repaint to clear highlight |
TickTock | 23:cd03f9c3395e | 481 | } |
TickTock | 62:ffd15edb5431 | 482 | |
TickTock | 23:cd03f9c3395e | 483 | break; |
garygid | 65:821fc79cd7fe | 484 | |
garygid | 67:2022fce701d0 | 485 | case 30: // right-most on top row |
garygid | 65:821fc79cd7fe | 486 | |
leafman | 98:9f8bab96edff | 487 | if (dMode[whichTouched]==configScreen) { |
garygid | 65:821fc79cd7fe | 488 | // step through skins |
garygid | 65:821fc79cd7fe | 489 | if( skin < maxSkin ) skin += 1 ; |
garygid | 65:821fc79cd7fe | 490 | else skin = 0 ; |
garygid | 65:821fc79cd7fe | 491 | |
garygid | 65:821fc79cd7fe | 492 | // repaint both screens, I think |
garygid | 65:821fc79cd7fe | 493 | lastDMode[whichTouched]=99;//repaint to clear highlight |
garygid | 65:821fc79cd7fe | 494 | // and re-paint the other screen too, to see new skin there |
garygid | 65:821fc79cd7fe | 495 | lastDMode[whichTouched ^ 1]=99; // repaint other screen (^ = XOR) |
garygid | 67:2022fce701d0 | 496 | } else if (dMode[whichTouched] == indexScreen) { // gg - index |
TickTock | 122:138a40892a4c | 497 | dMode[whichTouched] = healthScreen ; // Goto health screen |
TickTock | 73:62ee8eae3a84 | 498 | sMode=0; |
TickTock | 86:d1c9e8ac1c4b | 499 | } else { |
garygid | 65:821fc79cd7fe | 500 | lastDMode[whichTouched]=99;//repaint to clear highlight |
garygid | 65:821fc79cd7fe | 501 | } |
garygid | 65:821fc79cd7fe | 502 | |
garygid | 65:821fc79cd7fe | 503 | break; |
garygid | 54:6ce808d0995e | 504 | //---------------------------------- |
garygid | 54:6ce808d0995e | 505 | //---------------------------------- |
garygid | 67:2022fce701d0 | 506 | case 01: // left col middle row |
leafman | 98:9f8bab96edff | 507 | if (dMode[whichTouched]==configScreen) { |
TickTock | 23:cd03f9c3395e | 508 | logEn = !logEn; |
garygid | 67:2022fce701d0 | 509 | } else if (dMode[whichTouched] == indexScreen) { // gg - index |
TickTock | 73:62ee8eae3a84 | 510 | dMode[whichTouched] = cpScreen ; // GoTo CP Data Screen |
TickTock | 73:62ee8eae3a84 | 511 | sMode=0; |
TickTock | 42:4533b13b297d | 512 | } else if (dMode[whichTouched]==dateScreen){ |
TickTock | 25:ddf0ec209f03 | 513 | dtMode=(dtMode<6)?dtMode+1:0; |
TickTock | 42:4533b13b297d | 514 | lastDMode[whichTouched]=99; |
TickTock | 62:ffd15edb5431 | 515 | } else { |
TickTock | 62:ffd15edb5431 | 516 | lastDMode[whichTouched]=99;//repaint to clear highlight |
TickTock | 23:cd03f9c3395e | 517 | } |
TickTock | 62:ffd15edb5431 | 518 | |
TickTock | 23:cd03f9c3395e | 519 | break; |
garygid | 54:6ce808d0995e | 520 | //------------------------------ |
TickTock | 23:cd03f9c3395e | 521 | case 11: |
leafman | 98:9f8bab96edff | 522 | if (dMode[whichTouched]==configScreen){ |
TickTock | 77:7c136766466c | 523 | repeatPoll = !repeatPoll; |
TickTock | 33:a277743ebdeb | 524 | if (repeatPoll) { |
TickTock | 36:dbd39c315258 | 525 | autoPoll.attach(&autoPollISR,pollInt); |
TickTock | 33:a277743ebdeb | 526 | } else { |
TickTock | 36:dbd39c315258 | 527 | autoPoll.detach(); |
TickTock | 33:a277743ebdeb | 528 | } |
garygid | 67:2022fce701d0 | 529 | } else if (dMode[whichTouched] == indexScreen) { // gg - index |
garygid | 67:2022fce701d0 | 530 | dMode[whichTouched] = cpHistScreen ; // GoTo CP Hist Screen |
TickTock | 73:62ee8eae3a84 | 531 | sMode=0; |
TickTock | 42:4533b13b297d | 532 | } else if (dMode[whichTouched]==playbackScreen) { |
TickTock | 36:dbd39c315258 | 533 | // Start/stop playback |
TickTock | 36:dbd39c315258 | 534 | if(!playbackOpen){ |
TickTock | 125:f58b7ab2abee | 535 | if(!canIdle){ |
TickTock | 125:f58b7ab2abee | 536 | printMsg("Cannot playback while connected to canbus\n"); |
TickTock | 125:f58b7ab2abee | 537 | }else if(!logOpen){ |
TickTock | 109:3e6f0e8fca0d | 538 | efr = f_open(&efile,"playback.alc",FA_READ|FA_OPEN_EXISTING); |
TickTock | 50:83d5864c64a0 | 539 | lastDMode[whichTouched]=99;//force refresh |
TickTock | 109:3e6f0e8fca0d | 540 | if(efr != FR_OK){ |
TickTock | 116:5cd72bae7c12 | 541 | printMsg("Unable to open /usb/playback.alc\n"); // no playback.alc |
TickTock | 36:dbd39c315258 | 542 | spkr.beep(1000,0.25); |
TickTock | 36:dbd39c315258 | 543 | } else { |
TickTock | 36:dbd39c315258 | 544 | playbackOpen = true; |
TickTock | 50:83d5864c64a0 | 545 | playbackEn=true; |
TickTock | 50:83d5864c64a0 | 546 | playback.attach(&playbackISR,playbackInt); |
TickTock | 116:5cd72bae7c12 | 547 | printMsg("Starting playback\n"); // start playback |
TickTock | 36:dbd39c315258 | 548 | spkr.beep(2000,0.25); |
TickTock | 36:dbd39c315258 | 549 | can1.attach(&doNothing);// Stop recieving CAN data |
TickTock | 36:dbd39c315258 | 550 | can2.attach(&doNothing); |
TickTock | 36:dbd39c315258 | 551 | } |
TickTock | 36:dbd39c315258 | 552 | } else { |
TickTock | 117:49883c779a74 | 553 | printMsg("Must stop logging first\n"); |
TickTock | 36:dbd39c315258 | 554 | } |
TickTock | 36:dbd39c315258 | 555 | } else { |
TickTock | 36:dbd39c315258 | 556 | playback.detach(); |
TickTock | 109:3e6f0e8fca0d | 557 | f_close(&efile); |
TickTock | 36:dbd39c315258 | 558 | playbackOpen=false; |
TickTock | 50:83d5864c64a0 | 559 | playbackEn=false; |
TickTock | 36:dbd39c315258 | 560 | can1.attach(&recieve1);// Restore CAN data recieve |
TickTock | 36:dbd39c315258 | 561 | can2.attach(&recieve2); |
TickTock | 42:4533b13b297d | 562 | lastDMode[whichTouched]=99; |
TickTock | 36:dbd39c315258 | 563 | } |
TickTock | 42:4533b13b297d | 564 | } else if (dMode[whichTouched]==dateScreen){ |
TickTock | 25:ddf0ec209f03 | 565 | upDate(dtMode,true); |
TickTock | 42:4533b13b297d | 566 | lastDMode[whichTouched]=99; |
TickTock | 62:ffd15edb5431 | 567 | } else { |
TickTock | 62:ffd15edb5431 | 568 | lastDMode[whichTouched]=99;//repaint to clear highlight |
TickTock | 25:ddf0ec209f03 | 569 | } |
TickTock | 62:ffd15edb5431 | 570 | |
TickTock | 23:cd03f9c3395e | 571 | break; |
garygid | 54:6ce808d0995e | 572 | //--------------------------------- |
garygid | 54:6ce808d0995e | 573 | case 21: // col 2 row 1 |
leafman | 98:9f8bab96edff | 574 | if (dMode[whichTouched]==configScreen) { // gg - Batt Log Enable Button |
TickTock | 48:d1ce92104a1f | 575 | yesBattLog = !yesBattLog; |
garygid | 67:2022fce701d0 | 576 | } else if (dMode[whichTouched] == indexScreen) { // gg - index |
garygid | 67:2022fce701d0 | 577 | dMode[whichTouched] = cpBarScreen ; // GoTo CP Bars Screen |
TickTock | 73:62ee8eae3a84 | 578 | sMode=0; |
TickTock | 48:d1ce92104a1f | 579 | } else if (dMode[whichTouched]==dateScreen){ |
TickTock | 25:ddf0ec209f03 | 580 | upDate(dtMode,false); |
TickTock | 42:4533b13b297d | 581 | lastDMode[whichTouched]=99; |
TickTock | 62:ffd15edb5431 | 582 | } else { |
TickTock | 62:ffd15edb5431 | 583 | lastDMode[whichTouched]=99;//repaint to clear highlight |
TickTock | 25:ddf0ec209f03 | 584 | } |
TickTock | 62:ffd15edb5431 | 585 | |
TickTock | 23:cd03f9c3395e | 586 | break; |
garygid | 54:6ce808d0995e | 587 | |
garygid | 87:46ac3f2519d6 | 588 | case 31: // col 3 row 1 |
leafman | 98:9f8bab96edff | 589 | if (dMode[whichTouched]==configScreen) { // gg - Batt Log Enable Button |
garygid | 87:46ac3f2519d6 | 590 | debugMode = !debugMode; |
leafman | 98:9f8bab96edff | 591 | } else if (dMode[whichTouched] == indexScreen) { // gg - index |
leafman | 98:9f8bab96edff | 592 | dMode[whichTouched] = configScreen ; // GoTo Config Screen |
TickTock | 107:e9be732c1ad4 | 593 | } else if (dMode[whichTouched] == tripScreen) { |
TickTock | 108:29b5a760adc2 | 594 | miles_trip[1]=0; |
TickTock | 108:29b5a760adc2 | 595 | kWh_trip[1]=0; |
TickTock | 108:29b5a760adc2 | 596 | sMode=0; |
TickTock | 108:29b5a760adc2 | 597 | lastDMode[whichTouched]=99;//repaint to clear highlight |
garygid | 87:46ac3f2519d6 | 598 | } else { |
garygid | 87:46ac3f2519d6 | 599 | lastDMode[whichTouched]=99;//repaint to clear highlight |
garygid | 87:46ac3f2519d6 | 600 | } |
garygid | 87:46ac3f2519d6 | 601 | break; |
garygid | 87:46ac3f2519d6 | 602 | |
garygid | 54:6ce808d0995e | 603 | //----------------------------------- |
garygid | 67:2022fce701d0 | 604 | case 02: // left col, bottom row (not nav) |
garygid | 67:2022fce701d0 | 605 | if (dMode[whichTouched] == indexScreen) { // gg - index |
leafman | 98:9f8bab96edff | 606 | dMode[whichTouched] = playbackScreen ; // GoTo Playback Screen |
leafman | 98:9f8bab96edff | 607 | } else if (dMode[whichTouched]==configScreen) { |
leafman | 98:9f8bab96edff | 608 | metric = !metric; // toggle metric/imperial display |
garygid | 87:46ac3f2519d6 | 609 | } else { |
garygid | 87:46ac3f2519d6 | 610 | lastDMode[whichTouched]=99;//repaint to clear highlight |
garygid | 87:46ac3f2519d6 | 611 | } |
garygid | 67:2022fce701d0 | 612 | break; |
garygid | 67:2022fce701d0 | 613 | |
garygid | 67:2022fce701d0 | 614 | case 12: // left-middle col, bottom row (not nav) |
garygid | 67:2022fce701d0 | 615 | if (dMode[whichTouched] == indexScreen) { // gg - index |
leafman | 98:9f8bab96edff | 616 | dMode[whichTouched] = dateScreen ; // GoTo Set Date/Time Screen |
garygid | 87:46ac3f2519d6 | 617 | } else { |
garygid | 87:46ac3f2519d6 | 618 | lastDMode[whichTouched]=99;//repaint to clear highlight |
garygid | 87:46ac3f2519d6 | 619 | } |
garygid | 67:2022fce701d0 | 620 | break; |
garygid | 67:2022fce701d0 | 621 | |
garygid | 67:2022fce701d0 | 622 | case 22: // right-middle col, bottom row (not nav) |
garygid | 67:2022fce701d0 | 623 | if (dMode[whichTouched] == indexScreen) { // gg - index |
leafman | 98:9f8bab96edff | 624 | dMode[whichTouched] = logScreen ; |
garygid | 87:46ac3f2519d6 | 625 | } else { |
garygid | 87:46ac3f2519d6 | 626 | lastDMode[whichTouched]=99;//repaint to clear highlight |
garygid | 87:46ac3f2519d6 | 627 | } |
garygid | 67:2022fce701d0 | 628 | break; |
TickTock | 72:f9a6faa28873 | 629 | |
leafman | 98:9f8bab96edff | 630 | case 32: // right col, bottom row (not nav) |
leafman | 98:9f8bab96edff | 631 | if (dMode[whichTouched] == configScreen) { |
TickTock | 114:3f8c59a8a2b9 | 632 | logEn=false; |
leafman | 98:9f8bab96edff | 633 | updateFirmware(); |
TickTock | 107:e9be732c1ad4 | 634 | } else if (dMode[whichTouched] == tripScreen) { |
TickTock | 108:29b5a760adc2 | 635 | miles_trip[2]=0; |
TickTock | 108:29b5a760adc2 | 636 | kWh_trip[2]=0; |
TickTock | 73:62ee8eae3a84 | 637 | sMode=0; |
TickTock | 108:29b5a760adc2 | 638 | lastDMode[whichTouched]=99;//repaint to clear highlight |
TickTock | 108:29b5a760adc2 | 639 | } else if (dMode[whichTouched] == indexScreen) { |
TickTock | 108:29b5a760adc2 | 640 | dMode[whichTouched] = tripScreen ; |
leafman | 98:9f8bab96edff | 641 | } else { |
garygid | 87:46ac3f2519d6 | 642 | lastDMode[whichTouched]=99;//repaint to clear highlight |
TickTock | 72:f9a6faa28873 | 643 | } |
TickTock | 72:f9a6faa28873 | 644 | break; |
TickTock | 72:f9a6faa28873 | 645 | |
garygid | 67:2022fce701d0 | 646 | //----------------------------------- |
garygid | 54:6ce808d0995e | 647 | //----------------------------------- |
garygid | 54:6ce808d0995e | 648 | // Prev Navigation |
garygid | 54:6ce808d0995e | 649 | case 07: // col 0 row tNavRow |
TickTock | 42:4533b13b297d | 650 | dMode[whichTouched]=dMode[whichTouched]>0?dMode[whichTouched]-1:maxScreens; |
TickTock | 22:a43df3905863 | 651 | break; |
garygid | 54:6ce808d0995e | 652 | //----------------------------------- |
garygid | 54:6ce808d0995e | 653 | // Select Screen Navigation |
garygid | 54:6ce808d0995e | 654 | case 17: |
TickTock | 43:e7f6f80590e3 | 655 | //secsNoTouch = userTimeout; // immediately exit config mode |
TickTock | 43:e7f6f80590e3 | 656 | sMode=0; |
TickTock | 43:e7f6f80590e3 | 657 | lastDMode[whichTouched]=99; // Repaint |
TickTock | 22:a43df3905863 | 658 | break; |
garygid | 54:6ce808d0995e | 659 | //----------------------------------- |
garygid | 54:6ce808d0995e | 660 | // Index Navigation |
garygid | 54:6ce808d0995e | 661 | case 27: // col 2 row tNavRow |
garygid | 67:2022fce701d0 | 662 | dMode[whichTouched]= indexScreen ; // gg - index |
garygid | 54:6ce808d0995e | 663 | break; |
garygid | 54:6ce808d0995e | 664 | //------------------------------------ |
garygid | 54:6ce808d0995e | 665 | // Next Navigation |
garygid | 54:6ce808d0995e | 666 | case 37: // lower right on Nav Line gg - move next |
TickTock | 42:4533b13b297d | 667 | dMode[whichTouched]=dMode[whichTouched]<maxScreens?dMode[whichTouched]+1:0; |
TickTock | 22:a43df3905863 | 668 | break; |
garygid | 54:6ce808d0995e | 669 | //------------------------------------ |
garygid | 54:6ce808d0995e | 670 | //------------------------------------ |
TickTock | 22:a43df3905863 | 671 | default: |
TickTock | 62:ffd15edb5431 | 672 | lastDMode[whichTouched]=99;//repaint to clear highlight |
TickTock | 25:ddf0ec209f03 | 673 | break; |
TickTock | 25:ddf0ec209f03 | 674 | } |
TickTock | 23:cd03f9c3395e | 675 | break; |
TickTock | 23:cd03f9c3395e | 676 | case 2: // numpad |
TickTock | 23:cd03f9c3395e | 677 | break; |
TickTock | 23:cd03f9c3395e | 678 | case 3: |
TickTock | 23:cd03f9c3395e | 679 | break; |
TickTock | 23:cd03f9c3395e | 680 | default: |
TickTock | 23:cd03f9c3395e | 681 | break; |
TickTock | 23:cd03f9c3395e | 682 | } // case sMode |
TickTock | 22:a43df3905863 | 683 | } //recently touched |
TickTock | 4:8d7759f4fe7a | 684 | } else { // userIdle |
TickTock | 8:67eed72f3e10 | 685 | if(sMode==1){ |
TickTock | 8:67eed72f3e10 | 686 | sMode=0; |
TickTock | 43:e7f6f80590e3 | 687 | lastDMode[whichTouched]=99; |
TickTock | 8:67eed72f3e10 | 688 | } |
TickTock | 4:8d7759f4fe7a | 689 | } |
TickTock | 34:4751a8259b18 | 690 | |
TickTock | 34:4751a8259b18 | 691 | if(tick){ // Executes once a second |
TickTock | 108:29b5a760adc2 | 692 | tick=false; |
TickTock | 93:c2402e8cd0e2 | 693 | headlights = (lastMsg[indexLastMsg[0x358]].data[1]&0x80)?true:false; // headlight/turn signal indicator |
TickTock | 41:8d4609ea7259 | 694 | accV=floor(mon12V*scale12V*10+0.5)/10; //Round to nearest 10th |
TickTock | 35:5acbd8a64a89 | 695 | accOn=(accV>5)?true:false; |
TickTock | 121:553faf139a20 | 696 | charging=(mph[0]<0.1)&&(kW[0]<-1); // not moving and generating energy so much be charging |
TickTock | 49:a3d2c5bb3cfa | 697 | if(laccOn&&!accOn){ // Car turned off |
TickTock | 108:29b5a760adc2 | 698 | if (repeatPoll) { // Log on shutdown if autopoll enabled |
TickTock | 108:29b5a760adc2 | 699 | tripLog(); // Write trip log on powerdown |
TickTock | 108:29b5a760adc2 | 700 | } |
TickTock | 49:a3d2c5bb3cfa | 701 | //write efficiency history data |
TickTock | 97:a25940fd7b5b | 702 | hfile = fopen("/local/ehist.cny", "w"); |
TickTock | 97:a25940fd7b5b | 703 | if (hfile!=NULL){ // found a efficiency history file |
TickTock | 49:a3d2c5bb3cfa | 704 | for(i=0;i<39;i++){ |
TickTock | 97:a25940fd7b5b | 705 | fprintf(hfile,"%f %f\r\n",mph[i],kW[i]); |
TickTock | 49:a3d2c5bb3cfa | 706 | } |
TickTock | 97:a25940fd7b5b | 707 | fclose(hfile); |
TickTock | 49:a3d2c5bb3cfa | 708 | } |
TickTock | 49:a3d2c5bb3cfa | 709 | } |
TickTock | 107:e9be732c1ad4 | 710 | if(!laccOn&&accOn){ // Car turned on |
TickTock | 108:29b5a760adc2 | 711 | miles_trip[0]=0; |
TickTock | 108:29b5a760adc2 | 712 | kWh_trip[0]=0; |
TickTock | 115:549410af477d | 713 | wait5secs=5; |
TickTock | 115:549410af477d | 714 | } |
TickTock | 49:a3d2c5bb3cfa | 715 | laccOn=accOn; |
TickTock | 115:549410af477d | 716 | if(!accOn&&!logEn&&userIdle&&!playbackEn){ // Car off and logging disabled and no user activity |
TickTock | 115:549410af477d | 717 | dled = 0; |
TickTock | 35:5acbd8a64a89 | 718 | }else if(!headlights){ |
TickTock | 35:5acbd8a64a89 | 719 | dled = ledHi; |
TickTock | 115:549410af477d | 720 | } else { |
TickTock | 35:5acbd8a64a89 | 721 | dled = ledLo; |
TickTock | 34:4751a8259b18 | 722 | } |
TickTock | 115:549410af477d | 723 | if(wait5secs>0){ // Wait a few seconds after poweron to give BMS time to measure CP's |
TickTock | 115:549410af477d | 724 | wait5secs-=1; |
TickTock | 115:549410af477d | 725 | if (repeatPoll&&(wait5secs==0)) { // Poll on startup if autopoll enabled |
TickTock | 108:29b5a760adc2 | 726 | logOnce=true; |
TickTock | 112:b41b35401eb6 | 727 | reqMsgCnt=0; |
TickTock | 124:0d622967b764 | 728 | msgReq.attach(&sendReq,0.015); |
TickTock | 108:29b5a760adc2 | 729 | } |
TickTock | 107:e9be732c1ad4 | 730 | } |
TickTock | 115:549410af477d | 731 | |
TickTock | 49:a3d2c5bb3cfa | 732 | //compute historic efficiency |
TickTock | 41:8d4609ea7259 | 733 | if(numSsamples>0){ // Avoid div0 |
TickTock | 115:549410af477d | 734 | mph[0]=((float) motorRPM)/numSsamples/220; // Empirically derived with MXV4s - may change with different wheels&tires |
TickTock | 86:d1c9e8ac1c4b | 735 | } else { |
TickTock | 49:a3d2c5bb3cfa | 736 | mph[0]=0; |
TickTock | 36:dbd39c315258 | 737 | } |
TickTock | 49:a3d2c5bb3cfa | 738 | if(mph[0]>99){ |
TickTock | 49:a3d2c5bb3cfa | 739 | mph[0]=0; |
TickTock | 49:a3d2c5bb3cfa | 740 | } |
TickTock | 121:553faf139a20 | 741 | numSsamples=0; |
TickTock | 107:e9be732c1ad4 | 742 | |
TickTock | 41:8d4609ea7259 | 743 | if(numWsamples>0){ // Avoid div0 |
TickTock | 121:553faf139a20 | 744 | mpkWh[0]=mph[0]; |
TickTock | 49:a3d2c5bb3cfa | 745 | kW[0]=((float) mWs_x4)/numWsamples/4e3; |
TickTock | 49:a3d2c5bb3cfa | 746 | mpkWh[0]/=kW[0]; |
TickTock | 49:a3d2c5bb3cfa | 747 | if (mpkWh[0]<0) { |
TickTock | 49:a3d2c5bb3cfa | 748 | mpkWh[0]=99;// negative means inf. |
TickTock | 49:a3d2c5bb3cfa | 749 | } |
TickTock | 86:d1c9e8ac1c4b | 750 | } else { |
TickTock | 49:a3d2c5bb3cfa | 751 | kW[0]=0; |
TickTock | 49:a3d2c5bb3cfa | 752 | mpkWh[0]=0; |
TickTock | 49:a3d2c5bb3cfa | 753 | } |
TickTock | 121:553faf139a20 | 754 | numWsamples=0; |
TickTock | 121:553faf139a20 | 755 | |
TickTock | 121:553faf139a20 | 756 | if (!charging){ |
TickTock | 121:553faf139a20 | 757 | miles_trip[0]+=mph[0]/3600; |
TickTock | 121:553faf139a20 | 758 | miles_trip[1]+=mph[0]/3600; |
TickTock | 121:553faf139a20 | 759 | miles_trip[2]+=mph[0]/3600; |
TickTock | 121:553faf139a20 | 760 | kWh_trip[0]+=kW[0]/3600; |
TickTock | 121:553faf139a20 | 761 | kWh_trip[1]+=kW[0]/3600; |
TickTock | 121:553faf139a20 | 762 | kWh_trip[2]+=kW[0]/3600; |
TickTock | 121:553faf139a20 | 763 | } |
TickTock | 121:553faf139a20 | 764 | |
TickTock | 49:a3d2c5bb3cfa | 765 | motorRPM=0; |
TickTock | 40:0e6e71a7323f | 766 | mWs_x4=0; |
TickTock | 121:553faf139a20 | 767 | |
TickTock | 121:553faf139a20 | 768 | // Compute ESR |
TickTock | 121:553faf139a20 | 769 | if((Imax-Imin)<40){ // do nothing - insufficient delta_I to measure |
TickTock | 121:553faf139a20 | 770 | unloadedV_x2 = (curRmax+curRmin)/2; |
TickTock | 120:041edeec08f5 | 771 | }else if ((redRmax-redRmin)<(curRmax-curRmin)) { |
TickTock | 120:041edeec08f5 | 772 | Resr-=0.001; |
TickTock | 120:041edeec08f5 | 773 | unloadedV_x2 = (redRmax+redRmin)/2; |
TickTock | 120:041edeec08f5 | 774 | } else if ((incRmax-incRmin)<(curRmax-curRmin)) { |
TickTock | 120:041edeec08f5 | 775 | Resr+=0.001; |
TickTock | 120:041edeec08f5 | 776 | unloadedV_x2 = (incRmax+incRmin)/2; |
TickTock | 120:041edeec08f5 | 777 | } else { |
TickTock | 120:041edeec08f5 | 778 | unloadedV_x2 = (curRmax+curRmin)/2; |
TickTock | 120:041edeec08f5 | 779 | } |
TickTock | 120:041edeec08f5 | 780 | curRmin=1000; |
TickTock | 120:041edeec08f5 | 781 | curRmax=0; |
TickTock | 120:041edeec08f5 | 782 | incRmin=1000; |
TickTock | 120:041edeec08f5 | 783 | incRmax=0; |
TickTock | 120:041edeec08f5 | 784 | redRmin=1000; |
TickTock | 120:041edeec08f5 | 785 | redRmax=0; |
TickTock | 121:553faf139a20 | 786 | Imax=-1000; |
TickTock | 121:553faf139a20 | 787 | Imin=1000; |
TickTock | 121:553faf139a20 | 788 | |
TickTock | 121:553faf139a20 | 789 | if((accOn||playbackEn)&&!charging){ |
TickTock | 52:d5385fbf4ea1 | 790 | for(i=1;i<39;i++){ |
TickTock | 49:a3d2c5bb3cfa | 791 | average=mph[i]/timeConstant[i]; |
TickTock | 49:a3d2c5bb3cfa | 792 | mph[i]-=average; |
TickTock | 52:d5385fbf4ea1 | 793 | mph[i]+=mph[0]; |
TickTock | 52:d5385fbf4ea1 | 794 | mpkWh[i]=average; |
TickTock | 49:a3d2c5bb3cfa | 795 | average=kW[i]/timeConstant[i]; |
TickTock | 121:553faf139a20 | 796 | if(!charging){ //Not charging - so include in efficiency data |
TickTock | 97:a25940fd7b5b | 797 | kW[i]-=average; |
TickTock | 97:a25940fd7b5b | 798 | kW[i]+=kW[0]; |
TickTock | 97:a25940fd7b5b | 799 | } |
TickTock | 52:d5385fbf4ea1 | 800 | mpkWh[i]/=average; |
TickTock | 49:a3d2c5bb3cfa | 801 | if (mpkWh[i]<0) { |
TickTock | 49:a3d2c5bb3cfa | 802 | mpkWh[i]=99;// negative means inf. |
TickTock | 49:a3d2c5bb3cfa | 803 | } |
TickTock | 49:a3d2c5bb3cfa | 804 | //mpkWh[i]=floor(mpkWh[i]*10+0.5)/10; // Round to nearest 10th |
TickTock | 52:d5385fbf4ea1 | 805 | } |
TickTock | 49:a3d2c5bb3cfa | 806 | } |
TickTock | 108:29b5a760adc2 | 807 | if(logCP&&usbEn){ |
TickTock | 108:29b5a760adc2 | 808 | if(logOnce){ |
TickTock | 108:29b5a760adc2 | 809 | tripLog(); |
TickTock | 108:29b5a760adc2 | 810 | logOnce=false; |
TickTock | 108:29b5a760adc2 | 811 | } |
garygid | 69:6bfdfc002036 | 812 | logPackVoltages(); // Turbo3, only call |
TickTock | 108:29b5a760adc2 | 813 | } |
TickTock | 112:b41b35401eb6 | 814 | if(!usbEn&&!waitasec){ |
TickTock | 108:29b5a760adc2 | 815 | usbEn=detectUSB(); // Keep looking if none found |
TickTock | 108:29b5a760adc2 | 816 | } |
TickTock | 111:d1559bb25c43 | 817 | waitasec=false; // work around to avoid hang when USB tries to init immediately |
TickTock | 121:553faf139a20 | 818 | tock=true; |
TickTock | 121:553faf139a20 | 819 | } // tick |
TickTock | 36:dbd39c315258 | 820 | |
TickTock | 39:eef8beac7411 | 821 | display=display<1?display+1:0; // toggle display |
TickTock | 39:eef8beac7411 | 822 | updateDisplay(display); |
TickTock | 39:eef8beac7411 | 823 | |
TickTock | 36:dbd39c315258 | 824 | if(step){ // playback |
TickTock | 36:dbd39c315258 | 825 | if(playbackOpen&&playbackEn){ |
TickTock | 38:155ec32c5e91 | 826 | for(i=0;i<120;i++){ |
TickTock | 109:3e6f0e8fca0d | 827 | if(!f_eof(&efile)){ |
TickTock | 109:3e6f0e8fca0d | 828 | efr=f_read(&efile,&header,5,&bytesRW); |
TickTock | 109:3e6f0e8fca0d | 829 | efr=f_read(&efile,&data,8,&bytesRW); |
garygid | 69:6bfdfc002036 | 830 | logCan(header[0],CANMessage(0x7ff&((header[4]<<8)+header[3]), data, 8)); // Playback |
TickTock | 86:d1c9e8ac1c4b | 831 | } else { |
TickTock | 109:3e6f0e8fca0d | 832 | f_close(&efile); // restart |
TickTock | 109:3e6f0e8fca0d | 833 | efr = f_open(&efile,"playback.alc",FA_READ|FA_OPEN_EXISTING); |
TickTock | 50:83d5864c64a0 | 834 | lastDMode[whichTouched]=99;//force refresh |
TickTock | 36:dbd39c315258 | 835 | spkr.beep(2000,0.25); |
TickTock | 36:dbd39c315258 | 836 | } |
TickTock | 36:dbd39c315258 | 837 | } |
TickTock | 36:dbd39c315258 | 838 | } |
TickTock | 36:dbd39c315258 | 839 | step=false; |
TickTock | 36:dbd39c315258 | 840 | } |
TickTock | 37:fea2c1d52c5f | 841 | |
TickTock | 2:71b1999a8ea5 | 842 | } //while (true) |
TickTock | 0:1596b8644523 | 843 | } |