Dual CANbus monitor and instrumentation cluster. Presently tuned for the Nissan Leaf EV.
Dependencies: SPI_TFTx2_ILI9341 TFT_fonts TOUCH_TFTx2_ILI9341 mbed
Fork of CANary_corrupt by
After adding the LPC1768 platform, import as a program and do not select the "update to latest revision" box
User Guide
Eagle Schematic and Board design
/media/uploads/TickTock/canaryr6.zip
For LCD Rev 1.01:
For VCD Rev 2.00:
Parts List
Assembly
1) LCD Displays
I found ribbon cable is a nice way to organize the wires to the displays. There are two versions of the display and each must be wired differently. The original project used HW REV. 1.01. For that version, you'll need 12 conductors and I connected them in the following order:
1 | LED+ |
2 | LED- |
3 | RST |
4 | SDI |
5 | WR/SCLK |
6 | CS |
7 | X+ |
8 | X- |
9 | Y+ |
10 | Y- |
11 | VDD |
12 | GND |
If, instead, you have HW REV 2.0, you will need 13 conductors with the following order:
1 | LED+ |
2 | LED- |
3 | RST |
4 | SDI |
5 | RS (SCLK) |
6 | WR (DC) |
7 | CS |
8 | X+ |
9 | X- |
10 | Y+ |
11 | Y- |
12 | VDD |
13 | GND |
First I connected all the GND connections (2 GND & IM0, IM1, IM3 for REV1.01 or 2 GND, RD, & IM0 for REV2.00). Do not connect the bottom GND until you have the ribbon cable connected. After making all the ribbon cable connections (connecting the GND of the ribbon cable to the bottom GND pad), solder the GND bar from the previous step to the back of the bottom GND connection. Finally, make a connection from the back side 3.3V pin to IM2 for REV1.01 or to IM1,IM2,&IM3 for REV2.00. Take a break and repeat for the second display.
Examples of REV1.01 boards:
Examples of REV2.00:
Once the two displays are complete combine all wires except CS0, CS1, X+, X-, Y+, and Y-. Connect X- of the left display to X+ of the right. Similarly connect Y- of the left display to Y+ of the right. Insulate any exposed wires.
2) PCB
Refer to the schematics to place all the components on the board. If you plan to install into the CANary 3D enclosure, DO NOT install the battery holder or the socket for the mbed and, instead, connect two wires to the VB and GND pads nearby. You will have to install the battery holder against the back wall to avoid interfering with the right-hand display and the mbed will have to be directly soldered. I have not found a socket with a low enough profile to fit in the space provided (depth of enclosure is limited by the space behind the center console). Also, I recommend keeping as much lead as possible on the Zener diode (bending it as shown to clear the back wall). Although it is operating well within parameters, the Zener gets quite hot during extended operation and the leads help dissipate the heat and keep it away from the PCB and other components.Update: Several Zeners have failed resulting in damage to some users boards so I recommend using a DC-DC converter instead to bring the 12V down to 7V.
Once the PCB is populated, solder the LCDs to the PCB. CS0 connects to the right display and CS1 connects to the left.
Update: The Zener diodes tended to fail after a few months so I am recommending removing them and replacing with a DC-DC converter. This will run cooler and waste less energy, too. To install, remove the left display panel to gain access to the Zener. From there, the Zener can be removed and it's pads used to connect to the DC-DC converter. I recommend setting the output voltage on the bench before installing since the trim pot is tricky to reach once installed. Set it to 7V. The input can be connected to the left pad previously occupied by the zener and the output can connect to the right. GND(-) can be connected to the bottom right pad on the 2x6 header below the flex cable connector. Make sure the GND wire lies flat so it doesn't interfere with the connection of the flex cable.
Once soldered in place, the DC-DC converter can easily be mounted to the back wall with double sided tape above the battery holder.
3) Testing
1) | First step is to buzz out all connections from the LCDs to the pins in the main board |
2) | Next check the touch screen connections. On the main board, place an Ohm meter across X+ and X-. You should read 700 Ohms. Repeat for Y+ and Y-. Then test the resistance from X+ to Y+. With nothing touching the screens, it should read >100K Ohms and <1K when touching either screen. |
3) | When all connections are checked, solder in the mbed. Download and install the touch2 program http://mbed.org/users/TickTock/code/touch2/ to test the basic operation of the mbed and touch screens. |
tips: | |
Touch screen is sensitive - excess flux on X+,X-,Y+,Y- connection on mbed can result in flakey operation | |
If touch is not working, double-check the LCD0_CS and LCD1_CS are not swapped. LCD0_CS must connect to the CS of the LCD that has X- & Y- connected to the mbed. LCD1_CS must connect to the CS of the LCD that has X+ & Y+ connected to the mbed. | |
4) | Once touch2 works, it is time to connect to the OBD connector. I highly recommend double checking all connections from the OBD to the PCB with the cable in place before connecting to the Leaf. Buzz out all the pins in the OBS to make sure none are shorting to each other, Check that the 12V goes to the Zener (and nothing else) and the switched 12V to the resistor divider (and nothing else). Test the ground connection properly connects to ground and nothing else. |
5) | Once you are confident there are no shorts or wrong connections from the OBD connector, take a deep breath and plug it into your leaf. Touch2 program should come up and function. Unplug and install the latest CANary firmware. If you have the REV2.00 LCD boards, you will need to edit the precompile.h file in the TOUCH_TFTx2_w9341 library and set USE_ILI9341 to 1. Test all features before installing into the enclosure (gids, cellpair, menu system, logging) since installing and removing from the enclosure is a PITA. |
4) Enclosure
The 3D printer leaves a lot of powder behind - I used a strong spray of water to get it out of all the cracks. The enclosure comes with a rather rough finish. I recommend convincing yourself you like it, then simply lightly sand then paint before assembly. Sanding is very difficult - the nylon is very nicely fused and doesn't want to sand. I tried sandblasting and that didn't work either. I had some limited success with filler and then sanding, but only on the outside - it is too difficult to sand the face.
5) Final Assembly
Make sure you are well rested with lots of patience before attempting assembly. It is a puzzle figuring out how to get both displays and the PCB in place. Enclosure was too expensive for me to keep iterating to optimize for assembly. I ended up snipping the thin display posts shorter and using various tools to push the displays into place. Also, some USB connectors are taller than others. If you have one of the taller ones, you will have to deflect the back wall a bit while inserting the PCB (being careful not to bend the housing) to get it to it's opening in the back wall. Do use a screw in the provided post to secure the PCB as USB insertion will otherwise dislodge it.
I added an additional safety line which wraps around the center post to prevent the enclosure from becoming a projectile in the event of an accident. Installed:
utility.cpp@179:e4094e55f079, 2014-03-23 (annotated)
- Committer:
- TickTock
- Date:
- Sun Mar 23 22:04:44 2014 +0000
- Revision:
- 179:e4094e55f079
- Parent:
- 175:0357b4159b40
- Child:
- 193:5251831da396
Fixed bugs in whpg display
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
TickTock | 13:62e0f7f39ff5 | 1 | // utility.cpp |
TickTock | 13:62e0f7f39ff5 | 2 | #include "utility.h" |
TickTock | 174:cd27e80f197d | 3 | unsigned long brkMonRate = 378947; |
TickTock | 174:cd27e80f197d | 4 | unsigned short brkMonThr = 1895; |
TickTock | 155:f31006516956 | 5 | Timeout beepOff; |
TickTock | 160:905fe45ed54b | 6 | unsigned char bCount = 2; |
TickTock | 160:905fe45ed54b | 7 | float bFreq[2] = { 1000, 1000 }; |
TickTock | 160:905fe45ed54b | 8 | float bTime[2] = { 0.1, 0.1 }; |
TickTock | 13:62e0f7f39ff5 | 9 | |
TickTock | 13:62e0f7f39ff5 | 10 | void mbed_reset(); |
TickTock | 22:a43df3905863 | 11 | |
TickTock | 13:62e0f7f39ff5 | 12 | void RTC_IRQHandler() { |
TickTock | 13:62e0f7f39ff5 | 13 | timer.reset(); // zero ms at the-seconds-tic |
TickTock | 131:0d926c080a65 | 14 | carCanIdle=(++secsNoCarCanMsg>canTimeout)?true:false; |
TickTock | 132:08748a67280a | 15 | evCanIdle=(++secsNoEvCanMsg>canTimeout)?true:false; |
TickTock | 20:3bf176d14b14 | 16 | userIdle=(++secsNoTouch>userTimeout)?true:false; |
TickTock | 13:62e0f7f39ff5 | 17 | LPC_RTC->ILR |= (1<<0); // clear interrupt to prepare for next |
TickTock | 34:4751a8259b18 | 18 | tick=true; |
garygid | 69:6bfdfc002036 | 19 | // will use this to generate a logTP() just before the next Message received. |
garygid | 69:6bfdfc002036 | 20 | if( (time(NULL) % 60) == 0) ZeroSecTick = true; // gg - at 0-second of each minute |
TickTock | 13:62e0f7f39ff5 | 21 | } |
TickTock | 13:62e0f7f39ff5 | 22 | |
TickTock | 37:fea2c1d52c5f | 23 | void RTC_Init (void) { |
TickTock | 13:62e0f7f39ff5 | 24 | LPC_RTC->ILR=0x00; // set up the RTC interrupts |
TickTock | 13:62e0f7f39ff5 | 25 | LPC_RTC->CIIR=0x01; // interrupts each second |
TickTock | 13:62e0f7f39ff5 | 26 | LPC_RTC->CCR = 0x01; // Clock enable |
TickTock | 13:62e0f7f39ff5 | 27 | //NVIC_SetPriority( RTC_IRQn, 10 ); |
TickTock | 13:62e0f7f39ff5 | 28 | NVIC_EnableIRQ( RTC_IRQn ); |
TickTock | 13:62e0f7f39ff5 | 29 | } |
TickTock | 13:62e0f7f39ff5 | 30 | |
TickTock | 93:c2402e8cd0e2 | 31 | void printMsg (char *msg) { |
TickTock | 13:62e0f7f39ff5 | 32 | strcpy(displayLog[displayLoc],msg); |
TickTock | 13:62e0f7f39ff5 | 33 | displayLoc=displayLoc>17?0:displayLoc+1; |
TickTock | 13:62e0f7f39ff5 | 34 | } |
TickTock | 13:62e0f7f39ff5 | 35 | |
TickTock | 13:62e0f7f39ff5 | 36 | void touch_ISR(){ |
TickTock | 138:a2f5af85ed0d | 37 | //LPC_GPIOINT->IO2IntClr = (LPC_GPIOINT->IO2IntStatR | LPC_GPIOINT->IO2IntStatF); // seems to work without so maybe not necessary (performed in InterruptIn handler?) |
TickTock | 35:5acbd8a64a89 | 38 | touched=true; // just set flag - touch screen algorythm is long and we don't want to block other interrupts |
TickTock | 13:62e0f7f39ff5 | 39 | } |
TickTock | 13:62e0f7f39ff5 | 40 | |
TickTock | 13:62e0f7f39ff5 | 41 | unsigned short getTimeStamp() { |
TickTock | 13:62e0f7f39ff5 | 42 | unsigned short msec = timer.read_ms() ; // read ms from the timer |
TickTock | 13:62e0f7f39ff5 | 43 | unsigned long secs = time(NULL); // seconds past 12:00:00 AM 1 Jan 1900 |
TickTock | 13:62e0f7f39ff5 | 44 | unsigned short isecs = secs%60 ; // modulo 60 for 0-59 seconds from RTC |
TickTock | 13:62e0f7f39ff5 | 45 | return ((isecs<<10)+msec) ; // return the two byte time stamp |
TickTock | 13:62e0f7f39ff5 | 46 | } |
TickTock | 13:62e0f7f39ff5 | 47 | |
TickTock | 13:62e0f7f39ff5 | 48 | void logCan (char mType, CANMessage canRXmsg) { |
TickTock | 85:5c27e88b3fbe | 49 | |
TickTock | 85:5c27e88b3fbe | 50 | static unsigned char ii = 0; |
TickTock | 85:5c27e88b3fbe | 51 | static unsigned char lasti = 0; // indexindex |
TickTock | 37:fea2c1d52c5f | 52 | static unsigned char bdi=0; |
TickTock | 174:cd27e80f197d | 53 | static signed short imotorRPM = 0; |
TickTock | 85:5c27e88b3fbe | 54 | static unsigned short nLost = 0; // gg - overrun |
TickTock | 85:5c27e88b3fbe | 55 | |
TickTock | 83:52b1f330a62d | 56 | char sTemp[40]; |
TickTock | 92:935adef49ea4 | 57 | unsigned char changed; |
TickTock | 108:29b5a760adc2 | 58 | unsigned short i,j,k; |
TickTock | 119:0e2b641e98a2 | 59 | signed short packV_x2; |
TickTock | 119:0e2b641e98a2 | 60 | signed short packA_x2; |
TickTock | 40:0e6e71a7323f | 61 | signed long imWs_x4; |
garygid | 87:46ac3f2519d6 | 62 | unsigned short ts; |
TickTock | 85:5c27e88b3fbe | 63 | |
garygid | 87:46ac3f2519d6 | 64 | if(debugMode||(skin==ggSkin)){ |
TickTock | 161:71ac85d11f03 | 65 | // code to insert actual number of dropped frames for overrun debug - skipped in normal mode to keep logcan short |
TickTock | 85:5c27e88b3fbe | 66 | if(logOpen){ |
TickTock | 106:f016912a03db | 67 | // check to see if buffer is already full (read - write) = 1 |
TickTock | 106:f016912a03db | 68 | // actually the last buffer location cannot be used because then |
TickTock | 106:f016912a03db | 69 | // the buffer would look empty after writePointer++ |
TickTock | 106:f016912a03db | 70 | |
TickTock | 106:f016912a03db | 71 | //if (((writePointer+maxBufLen-readPointer)%maxBufLen)>(maxBufLen/16)) // modulo is slow? |
TickTock | 106:f016912a03db | 72 | |
TickTock | 106:f016912a03db | 73 | // pointers are 0 through maxBufLen-1 |
TickTock | 106:f016912a03db | 74 | if( (readPointer - writePointer) == 1 || (writePointer - readPointer) == (maxBufLen - 1)) { |
TickTock | 106:f016912a03db | 75 | // the buffer is "full", so Lose this message |
TickTock | 85:5c27e88b3fbe | 76 | |
TickTock | 106:f016912a03db | 77 | // point to the last-stored message |
TickTock | 106:f016912a03db | 78 | int tempWritePointer = writePointer - 1 ; |
TickTock | 106:f016912a03db | 79 | if( tempWritePointer < 0 ) tempWritePointer = maxBufLen - 1; |
TickTock | 106:f016912a03db | 80 | char strLost[9] ; |
TickTock | 106:f016912a03db | 81 | |
TickTock | 106:f016912a03db | 82 | if( nLost == 0 ) { |
TickTock | 106:f016912a03db | 83 | // this is the first message lost |
TickTock | 106:f016912a03db | 84 | // and we must overwrite the last message with an FFE comment message |
TickTock | 106:f016912a03db | 85 | // So, there will be two messages lost as the comment message is laid in. |
TickTock | 106:f016912a03db | 86 | nLost = 2; |
TickTock | 106:f016912a03db | 87 | sprintf(strLost,"%s","Lost0002"); // indicate two messages lost |
TickTock | 85:5c27e88b3fbe | 88 | |
TickTock | 106:f016912a03db | 89 | // overlay the last message with a "Lost0002" comment |
TickTock | 106:f016912a03db | 90 | writeBuffer[tempWritePointer][0]=0; |
TickTock | 117:49883c779a74 | 91 | // leave the ts of the overlaid message |
TickTock | 117:49883c779a74 | 92 | //writeBuffer[tempWritePointer][1]=(ts&0xff00)>>8; // Time Stamp (2 bytes_ |
TickTock | 117:49883c779a74 | 93 | //writeBuffer[tempWritePointer][2]=(ts&0x00ff); |
TickTock | 106:f016912a03db | 94 | // force the MsgID to an Event Message |
TickTock | 106:f016912a03db | 95 | writeBuffer[tempWritePointer][3]=0xfe; // MsgID, low byte |
TickTock | 106:f016912a03db | 96 | writeBuffer[tempWritePointer][4]=0xff; // Len nibble, and MsgID high nibble |
TickTock | 106:f016912a03db | 97 | // lay in the "Lost0002" text |
TickTock | 106:f016912a03db | 98 | for(i=5;i<13;i++){ |
TickTock | 106:f016912a03db | 99 | writeBuffer[tempWritePointer][i]= strLost[i-5]; |
TickTock | 85:5c27e88b3fbe | 100 | } |
TickTock | 85:5c27e88b3fbe | 101 | } else { |
TickTock | 106:f016912a03db | 102 | // at least one message was previously lost |
TickTock | 106:f016912a03db | 103 | // increment the loat counter |
TickTock | 106:f016912a03db | 104 | nLost += 1; |
garygid | 87:46ac3f2519d6 | 105 | |
TickTock | 106:f016912a03db | 106 | // lay the new count into the comment |
TickTock | 106:f016912a03db | 107 | sprintf(strLost,"%04d",nLost); |
TickTock | 106:f016912a03db | 108 | for(i=9;i<13;i++){ |
TickTock | 106:f016912a03db | 109 | writeBuffer[tempWritePointer][i]= strLost[i-9]; |
TickTock | 85:5c27e88b3fbe | 110 | } |
TickTock | 106:f016912a03db | 111 | } |
TickTock | 106:f016912a03db | 112 | } else { |
TickTock | 106:f016912a03db | 113 | // there is room to insert the message |
TickTock | 106:f016912a03db | 114 | // get it inserted quickly |
TickTock | 106:f016912a03db | 115 | ts=getTimeStamp(); |
TickTock | 106:f016912a03db | 116 | writeBuffer[writePointer][0]=mType; |
TickTock | 106:f016912a03db | 117 | writeBuffer[writePointer][1]=(ts&0xff00)>>8; // Time Stamp (2 bytes_ |
TickTock | 106:f016912a03db | 118 | writeBuffer[writePointer][2]=(ts&0x00ff); |
TickTock | 106:f016912a03db | 119 | writeBuffer[writePointer][3]=canRXmsg.id&0xff; // MsgID, low byte |
TickTock | 106:f016912a03db | 120 | char sLen = canRXmsg.len ; |
TickTock | 106:f016912a03db | 121 | writeBuffer[writePointer][4]=(canRXmsg.id>>8)+(sLen<<4); // Len nibble, and MsgID high nibble |
TickTock | 106:f016912a03db | 122 | for(i=0;i<8;i++){ // Is there a better way to do this? (writeBuffer[writePointer][i]=canRXmsg.data?) |
TickTock | 106:f016912a03db | 123 | if(i<sLen) |
TickTock | 106:f016912a03db | 124 | writeBuffer[writePointer][i+5]=canRXmsg.data[i]; |
TickTock | 106:f016912a03db | 125 | else // i>=sLen |
TickTock | 106:f016912a03db | 126 | // force unused data bytes to FF for CAN-Do compatibility |
TickTock | 106:f016912a03db | 127 | writeBuffer[writePointer][i+5]=0xFF; |
TickTock | 85:5c27e88b3fbe | 128 | } |
TickTock | 106:f016912a03db | 129 | |
TickTock | 106:f016912a03db | 130 | //-------------- |
TickTock | 106:f016912a03db | 131 | // Note, this is not protected from the interrupt. |
TickTock | 106:f016912a03db | 132 | // Due to the nLost code above, this no longer |
TickTock | 106:f016912a03db | 133 | // overflows to writePointer = readPointer |
TickTock | 106:f016912a03db | 134 | // which would make the buffer look empty |
TickTock | 106:f016912a03db | 135 | if (++writePointer >= maxBufLen) { |
TickTock | 106:f016912a03db | 136 | writePointer = 0; |
TickTock | 106:f016912a03db | 137 | led3 = !led3; |
TickTock | 106:f016912a03db | 138 | } |
TickTock | 106:f016912a03db | 139 | //-------------- |
TickTock | 106:f016912a03db | 140 | // log a local message if we had lost messages. gg - logcan |
TickTock | 106:f016912a03db | 141 | if( nLost > 0 ) { |
TickTock | 106:f016912a03db | 142 | // We previously lost messages that did not get into the buffer |
TickTock | 106:f016912a03db | 143 | sprintf(sTemp,"-- Lost %d Messages.\n", nLost); |
TickTock | 106:f016912a03db | 144 | printMsg(sTemp); // write buffer overrun |
TickTock | 156:4e5d30535cf9 | 145 | beep(500,0.25); |
TickTock | 106:f016912a03db | 146 | |
TickTock | 106:f016912a03db | 147 | nLost = 0 ; |
TickTock | 106:f016912a03db | 148 | } |
TickTock | 106:f016912a03db | 149 | //-------------- |
TickTock | 13:62e0f7f39ff5 | 150 | } |
TickTock | 85:5c27e88b3fbe | 151 | } |
TickTock | 92:935adef49ea4 | 152 | }else{ // not debugMode - keep code short |
TickTock | 85:5c27e88b3fbe | 153 | if(logOpen){ |
TickTock | 106:f016912a03db | 154 | NVIC_DisableIRQ(CAN_IRQn); // Block interrupts until write pointer assigned |
TickTock | 106:f016912a03db | 155 | int localWritePointer = writePointer++; // create local copy to make logCan reentrant |
TickTock | 106:f016912a03db | 156 | // note that the static variables do not prevent safe reentry |
TickTock | 106:f016912a03db | 157 | // since they are only used for msgId<0x800 which will never interrupt |
TickTock | 106:f016912a03db | 158 | // another msgId<0x800 (both CANbusses are same priority) |
TickTock | 106:f016912a03db | 159 | if (writePointer >= maxBufLen) { |
TickTock | 77:7c136766466c | 160 | writePointer = 0; |
TickTock | 77:7c136766466c | 161 | led3 = !led3; |
TickTock | 77:7c136766466c | 162 | } |
TickTock | 106:f016912a03db | 163 | NVIC_EnableIRQ(CAN_IRQn); // Unblock interrupts once local pointer set and global pointer incremented |
TickTock | 106:f016912a03db | 164 | ts=getTimeStamp(); |
TickTock | 106:f016912a03db | 165 | writeBuffer[localWritePointer][0]=mType; |
TickTock | 106:f016912a03db | 166 | writeBuffer[localWritePointer][1]=(ts&0xff00)>>8; |
TickTock | 106:f016912a03db | 167 | writeBuffer[localWritePointer][2]=(ts&0x00ff); |
TickTock | 106:f016912a03db | 168 | writeBuffer[localWritePointer][3]=canRXmsg.id&0xff; |
TickTock | 106:f016912a03db | 169 | writeBuffer[localWritePointer][4]=(canRXmsg.id>>8)+(canRXmsg.len<<4); |
TickTock | 161:71ac85d11f03 | 170 | for(i=5;i<13;i++){ // Is there a better way to do this? |
TickTock | 106:f016912a03db | 171 | writeBuffer[localWritePointer][i]=canRXmsg.data[i-5]; |
TickTock | 106:f016912a03db | 172 | } |
TickTock | 75:77bd26829dca | 173 | if (writePointer==readPointer) { |
TickTock | 117:49883c779a74 | 174 | // Just caught up to read pointer |
TickTock | 117:49883c779a74 | 175 | printMsg("Write buffer overrun.\n"); // write buffer overrun |
TickTock | 156:4e5d30535cf9 | 176 | //beep(500,0.25); |
TickTock | 13:62e0f7f39ff5 | 177 | } |
TickTock | 13:62e0f7f39ff5 | 178 | } |
TickTock | 37:fea2c1d52c5f | 179 | } |
TickTock | 40:0e6e71a7323f | 180 | |
TickTock | 83:52b1f330a62d | 181 | if(canRXmsg.id<0x800){ // Block FFE and FFF messages |
TickTock | 83:52b1f330a62d | 182 | if(indexLastMsg[canRXmsg.id]==0) { //Check if no entry |
garygid | 87:46ac3f2519d6 | 183 | if(ii<99) { |
garygid | 87:46ac3f2519d6 | 184 | indexLastMsg[canRXmsg.id]=++ii; //Create entry for first MsgID occurance |
garygid | 87:46ac3f2519d6 | 185 | // ii max is 99 here |
garygid | 87:46ac3f2519d6 | 186 | } else { |
garygid | 87:46ac3f2519d6 | 187 | // the ii array is full, more than 100 MsgIDs found |
garygid | 87:46ac3f2519d6 | 188 | if(ii==99) { |
TickTock | 92:935adef49ea4 | 189 | ii++; // step to 100 to log only one error |
TickTock | 161:71ac85d11f03 | 190 | printMsg("msgID buffer overrun.\n"); |
TickTock | 161:71ac85d11f03 | 191 | beep3(500,0.25,1000,0.5,500,0.25); //Alert driver to check log |
garygid | 87:46ac3f2519d6 | 192 | } |
TickTock | 13:62e0f7f39ff5 | 193 | } |
TickTock | 13:62e0f7f39ff5 | 194 | } |
TickTock | 161:71ac85d11f03 | 195 | lastMsg[indexLastMsg[canRXmsg.id]]=canRXmsg; //Store data in table at assigned index |
garygid | 87:46ac3f2519d6 | 196 | |
garygid | 87:46ac3f2519d6 | 197 | //---------------- |
TickTock | 85:5c27e88b3fbe | 198 | if(dMode[0]==changedScreen||dMode[1]==changedScreen){// Skip if not using (for execution speed) |
TickTock | 83:52b1f330a62d | 199 | changed=msgChanged[indexLastMsg[canRXmsg.id]]; |
TickTock | 85:5c27e88b3fbe | 200 | // This is cleared in the main loop when reset button is touched |
TickTock | 92:935adef49ea4 | 201 | for(i=0;i<8;i++){ |
TickTock | 83:52b1f330a62d | 202 | if(lastMsg[indexLastMsg[canRXmsg.id]].data[i]!=canRXmsg.data[i]){ |
TickTock | 83:52b1f330a62d | 203 | changed |= 1<<i; |
garygid | 80:24f1793171e7 | 204 | } |
TickTock | 13:62e0f7f39ff5 | 205 | } |
TickTock | 83:52b1f330a62d | 206 | msgChanged[indexLastMsg[canRXmsg.id]]=changed; |
TickTock | 13:62e0f7f39ff5 | 207 | } |
garygid | 87:46ac3f2519d6 | 208 | |
garygid | 87:46ac3f2519d6 | 209 | //------------------- |
TickTock | 83:52b1f330a62d | 210 | //Miscellaneous on-recieve operations below |
TickTock | 124:0d622967b764 | 211 | if((mType==1)&&(canRXmsg.id==0x7bb)){ // is battery data? Need to store all responses |
TickTock | 124:0d622967b764 | 212 | if(canRXmsg.data[0]<0x20){ |
TickTock | 115:549410af477d | 213 | if(canRXmsg.data[3]==1){//Group 1 data |
TickTock | 124:0d622967b764 | 214 | bdi=BatDataBaseG1; // index offset for Group 1 data |
TickTock | 115:549410af477d | 215 | if(debugMode){ |
TickTock | 116:5cd72bae7c12 | 216 | printMsg(" Getting Group 1 data\n"); |
TickTock | 115:549410af477d | 217 | } |
TickTock | 115:549410af477d | 218 | |
TickTock | 115:549410af477d | 219 | }else if(canRXmsg.data[3]==2){//Group 2 = cellpair data |
TickTock | 124:0d622967b764 | 220 | bdi=BatDataBaseG2; // index offset for CP data |
TickTock | 97:a25940fd7b5b | 221 | if(debugMode){ |
TickTock | 116:5cd72bae7c12 | 222 | printMsg(" Getting cell pair data\n"); |
TickTock | 97:a25940fd7b5b | 223 | } |
garygid | 87:46ac3f2519d6 | 224 | |
TickTock | 115:549410af477d | 225 | }else if(canRXmsg.data[3]==3){//Group 3 data |
TickTock | 124:0d622967b764 | 226 | bdi=BatDataBaseG3; // index offset for Group 3 data |
TickTock | 115:549410af477d | 227 | if(debugMode){ |
TickTock | 116:5cd72bae7c12 | 228 | printMsg(" Getting Group 3 data\n"); |
TickTock | 115:549410af477d | 229 | } |
TickTock | 115:549410af477d | 230 | |
garygid | 87:46ac3f2519d6 | 231 | }else if(canRXmsg.data[3]==4){//Group 4 = temperature data |
TickTock | 124:0d622967b764 | 232 | bdi=BatDataBaseG4; // index offset for Temperature data |
TickTock | 97:a25940fd7b5b | 233 | if(debugMode){ |
TickTock | 116:5cd72bae7c12 | 234 | printMsg(" Getting temperature data\n"); |
TickTock | 97:a25940fd7b5b | 235 | } |
garygid | 87:46ac3f2519d6 | 236 | |
garygid | 87:46ac3f2519d6 | 237 | }else if(canRXmsg.data[3]==5){//Group 5 data |
TickTock | 124:0d622967b764 | 238 | bdi=BatDataBaseG5; // index offset for Group 5 data |
TickTock | 97:a25940fd7b5b | 239 | if(debugMode){ |
TickTock | 116:5cd72bae7c12 | 240 | printMsg(" Getting Group 5 data\n"); |
TickTock | 97:a25940fd7b5b | 241 | } |
garygid | 87:46ac3f2519d6 | 242 | |
TickTock | 121:553faf139a20 | 243 | }else if(canRXmsg.data[3]==6){//Group 6 data = shunt data |
TickTock | 124:0d622967b764 | 244 | bdi=BatDataBaseG6; // index offset for Group 6 data |
TickTock | 121:553faf139a20 | 245 | if(debugMode){ |
TickTock | 121:553faf139a20 | 246 | printMsg(" Getting Group 6 data\n"); |
TickTock | 121:553faf139a20 | 247 | } |
TickTock | 121:553faf139a20 | 248 | |
TickTock | 83:52b1f330a62d | 249 | }else bdi=0xff; // ignore other messages (for now) |
TickTock | 83:52b1f330a62d | 250 | lasti=0; |
TickTock | 83:52b1f330a62d | 251 | } |
garygid | 87:46ac3f2519d6 | 252 | |
TickTock | 83:52b1f330a62d | 253 | if(bdi<0xff){ |
TickTock | 83:52b1f330a62d | 254 | i=canRXmsg.data[0]&0x0f; //lower nibble of D0 is index |
TickTock | 83:52b1f330a62d | 255 | if(lasti>i){ //detect rollover and offset index appropriately |
TickTock | 115:549410af477d | 256 | bdi += 0x10; // for CP data |
TickTock | 83:52b1f330a62d | 257 | } |
TickTock | 83:52b1f330a62d | 258 | lasti=i; //remember the msb to detect rollover next time around |
TickTock | 83:52b1f330a62d | 259 | i+=bdi; |
garygid | 87:46ac3f2519d6 | 260 | //------- |
TickTock | 121:553faf139a20 | 261 | //------- |
TickTock | 121:553faf139a20 | 262 | i*=7; |
TickTock | 124:0d622967b764 | 263 | if(i+6 < BatDataBufMax) { |
TickTock | 124:0d622967b764 | 264 | battData[i+0]=canRXmsg.data[1]; |
TickTock | 124:0d622967b764 | 265 | battData[i+1]=canRXmsg.data[2]; |
TickTock | 124:0d622967b764 | 266 | battData[i+2]=canRXmsg.data[3]; |
TickTock | 124:0d622967b764 | 267 | battData[i+3]=canRXmsg.data[4]; |
TickTock | 124:0d622967b764 | 268 | battData[i+4]=canRXmsg.data[5]; |
TickTock | 124:0d622967b764 | 269 | battData[i+5]=canRXmsg.data[6]; |
TickTock | 124:0d622967b764 | 270 | battData[i+6]=canRXmsg.data[7]; |
TickTock | 121:553faf139a20 | 271 | } |
TickTock | 124:0d622967b764 | 272 | if(i==(BatDataBaseG6+3)*7){ // All data loaded |
TickTock | 83:52b1f330a62d | 273 | logCP=yesBattLog; // Only log if logging enabled |
TickTock | 83:52b1f330a62d | 274 | showCP=true; // Always show |
TickTock | 121:553faf139a20 | 275 | |
TickTock | 121:553faf139a20 | 276 | // Find hottest temperature by finding smallest ADC value |
TickTock | 102:fd19f777a0b4 | 277 | // 2013 models only have three sensors |
TickTock | 124:0d622967b764 | 278 | k=battData[(BatDataBaseG4*7)+3]*0x100+battData[(BatDataBaseG4*7)+4]; |
TickTock | 124:0d622967b764 | 279 | j=battData[(BatDataBaseG4*7)+6]*0x100+battData[(BatDataBaseG4*7)+7]; |
TickTock | 115:549410af477d | 280 | if(j<k)k=j; |
TickTock | 124:0d622967b764 | 281 | j=battData[(BatDataBaseG4*7)+9]*0x100+battData[(BatDataBaseG4*7)+10]; |
TickTock | 115:549410af477d | 282 | if(j<k)k=j; |
TickTock | 124:0d622967b764 | 283 | j=battData[(BatDataBaseG4*7)+12]*0x100+battData[(BatDataBaseG4*7)+13]; |
TickTock | 115:549410af477d | 284 | if(j<k)k=j; |
TickTock | 108:29b5a760adc2 | 285 | //interpolate from lookup table |
TickTock | 175:0357b4159b40 | 286 | unsigned short temp_adc[10] = {1000,720,690,589,487,401,365,340,309,000}; |
TickTock | 175:0357b4159b40 | 287 | float temp_C[10] = { -27, 0, 3, 13, 23, 32, 36, 39, 43, 76}; |
TickTock | 108:29b5a760adc2 | 288 | char ii=0; |
TickTock | 108:29b5a760adc2 | 289 | while(k<=temp_adc[++ii]) { } // Find section in table |
TickTock | 108:29b5a760adc2 | 290 | maxTemp=(float)(k-temp_adc[ii]); |
TickTock | 108:29b5a760adc2 | 291 | maxTemp/=(float)(temp_adc[ii-1]-temp_adc[ii]); |
TickTock | 108:29b5a760adc2 | 292 | maxTemp*=(temp_C[ii-1]-temp_C[ii]); |
TickTock | 108:29b5a760adc2 | 293 | maxTemp+=temp_C[ii]; |
TickTock | 41:8d4609ea7259 | 294 | |
TickTock | 121:553faf139a20 | 295 | // Get state of health |
TickTock | 143:88b5155622a5 | 296 | SOH2_x100=battData[(BatDataBaseG1*7)+29]*0x100+battData[(BatDataBaseG1*7)+30]; |
TickTock | 124:0d622967b764 | 297 | Ah_x10000=battData[(BatDataBaseG1*7)+36]*0x10000+battData[(BatDataBaseG1*7)+37]*0x100+battData[(BatDataBaseG1*7)+38]; |
TickTock | 124:0d622967b764 | 298 | SOC_x10000=battData[(BatDataBaseG1*7)+32]*0x10000+battData[(BatDataBaseG1*7)+33]*0x100+battData[(BatDataBaseG1*7)+34]; |
TickTock | 143:88b5155622a5 | 299 | accV2=(float)battData[(BatDataBaseG1*7)+23]/4+(float)battData[(BatDataBaseG1*7)+24]/1024; |
TickTock | 121:553faf139a20 | 300 | |
TickTock | 121:553faf139a20 | 301 | // Save shunt data |
TickTock | 121:553faf139a20 | 302 | for(j=0; j<24; j++){ |
TickTock | 124:0d622967b764 | 303 | shunt[j*4+0]=battData[BatDataBaseG6*7+j+3]&0x08; |
TickTock | 124:0d622967b764 | 304 | shunt[j*4+1]=battData[BatDataBaseG6*7+j+3]&0x04; |
TickTock | 124:0d622967b764 | 305 | shunt[j*4+2]=battData[BatDataBaseG6*7+j+3]&0x02; |
TickTock | 124:0d622967b764 | 306 | shunt[j*4+3]=battData[BatDataBaseG6*7+j+3]&0x01; |
TickTock | 121:553faf139a20 | 307 | } |
TickTock | 83:52b1f330a62d | 308 | } |
TickTock | 83:52b1f330a62d | 309 | } |
TickTock | 83:52b1f330a62d | 310 | }else if((mType==1)&&(canRXmsg.id==0x1db)){ //Battery Volts and Amps |
TickTock | 119:0e2b641e98a2 | 311 | packV_x2=((canRXmsg.data[2]<<2)|(canRXmsg.data[3]>>6)); // 1 LSB = 0.5V |
TickTock | 119:0e2b641e98a2 | 312 | packA_x2=((canRXmsg.data[0]<<3)|(canRXmsg.data[1]>>5)); // 1 LSB = 0.5A |
TickTock | 119:0e2b641e98a2 | 313 | if(packA_x2>0x03ff){ |
TickTock | 119:0e2b641e98a2 | 314 | packA_x2|=0xf800;//extend sign; |
TickTock | 83:52b1f330a62d | 315 | } |
TickTock | 159:577e9d015693 | 316 | packA_x2 -= 2; //Slight correction to value required (unique to my Leaf?) |
TickTock | 121:553faf139a20 | 317 | if (-packA_x2<Imin){ |
TickTock | 121:553faf139a20 | 318 | Imin=-packA_x2; |
TickTock | 121:553faf139a20 | 319 | } else if (-packA_x2>Imax){ |
TickTock | 121:553faf139a20 | 320 | Imax=-packA_x2; |
TickTock | 121:553faf139a20 | 321 | } |
TickTock | 119:0e2b641e98a2 | 322 | imWs_x4 = packV_x2; // Volts*milliSeconds*2 |
TickTock | 119:0e2b641e98a2 | 323 | imWs_x4 *= -packA_x2; // milliWattseconds*4 |
TickTock | 118:02010b18efdc | 324 | mWs_x4 += imWs_x4; // total mWs_x4 |
TickTock | 121:553faf139a20 | 325 | float temp; |
TickTock | 121:553faf139a20 | 326 | temp = Resr; |
TickTock | 121:553faf139a20 | 327 | temp *= (float) -packA_x2; |
TickTock | 121:553faf139a20 | 328 | temp += (float) packV_x2; |
TickTock | 120:041edeec08f5 | 329 | if(temp>curRmax){ |
TickTock | 120:041edeec08f5 | 330 | curRmax=temp; |
TickTock | 120:041edeec08f5 | 331 | } else if(temp<curRmin){ |
TickTock | 120:041edeec08f5 | 332 | curRmin=temp; |
TickTock | 120:041edeec08f5 | 333 | } |
TickTock | 121:553faf139a20 | 334 | temp = Resr-0.001; |
TickTock | 121:553faf139a20 | 335 | temp *= (float) -packA_x2; |
TickTock | 121:553faf139a20 | 336 | temp += (float) packV_x2; |
TickTock | 120:041edeec08f5 | 337 | if(temp>redRmax){ |
TickTock | 120:041edeec08f5 | 338 | redRmax=temp; |
TickTock | 120:041edeec08f5 | 339 | } else if(temp<redRmin){ |
TickTock | 120:041edeec08f5 | 340 | redRmin=temp; |
TickTock | 120:041edeec08f5 | 341 | } |
TickTock | 121:553faf139a20 | 342 | temp = Resr+0.001; |
TickTock | 121:553faf139a20 | 343 | temp *= (float) -packA_x2; |
TickTock | 121:553faf139a20 | 344 | temp += (float) packV_x2; |
TickTock | 120:041edeec08f5 | 345 | if(temp>incRmax){ |
TickTock | 120:041edeec08f5 | 346 | incRmax=temp; |
TickTock | 120:041edeec08f5 | 347 | } else if(temp<incRmin){ |
TickTock | 120:041edeec08f5 | 348 | incRmin=temp; |
TickTock | 120:041edeec08f5 | 349 | } |
TickTock | 118:02010b18efdc | 350 | numWsamples++; |
TickTock | 174:cd27e80f197d | 351 | }else if((mType==2)&&(canRXmsg.id==0x176)){ //Motor Speed |
TickTock | 174:cd27e80f197d | 352 | imotorRPM=((canRXmsg.data[2]<<8)|(canRXmsg.data[3])); |
TickTock | 174:cd27e80f197d | 353 | motorRPM+=imotorRPM; |
TickTock | 92:935adef49ea4 | 354 | numSsamples++; |
TickTock | 174:cd27e80f197d | 355 | // }else if((mType==1)&&(canRXmsg.id==0x1da)){ //Motor Speed |
TickTock | 174:cd27e80f197d | 356 | // imotorRPM_x2=((canRXmsg.data[4]<<8)|(canRXmsg.data[5])); |
TickTock | 174:cd27e80f197d | 357 | // if(imotorRPM_x2<0){ // take absolute value |
TickTock | 174:cd27e80f197d | 358 | // imotorRPM_x2=-imotorRPM_x2; |
TickTock | 174:cd27e80f197d | 359 | // } |
TickTock | 174:cd27e80f197d | 360 | // motorRPM_x2+=imotorRPM_x2; |
TickTock | 174:cd27e80f197d | 361 | // numSsamples++; |
TickTock | 148:6e3b9135fad2 | 362 | // }else if((mType==2)&&(canRXmsg.id==0x1ca)){ //Brake Pressure |
TickTock | 148:6e3b9135fad2 | 363 | }else if((mType==2)&&(canRXmsg.id==0x292)){ //Brake Pressure |
TickTock | 140:ab3e94eb0227 | 364 | if(brakeMon){ |
TickTock | 140:ab3e94eb0227 | 365 | if(canRXmsg.data[0]<0xff){ |
TickTock | 174:cd27e80f197d | 366 | if((canRXmsg.data[6]*imotorRPM)<brkMonThr){ // brkMonThr = 3.6/.0019 = 1895 --> squelch threshold 1Wh/sec |
TickTock | 140:ab3e94eb0227 | 367 | chirpInt=0; |
TickTock | 174:cd27e80f197d | 368 | }else{ // imotorRPM*data[6]*.0019=kW; 3.6/kW = seconds until 1Wh; |
TickTock | 174:cd27e80f197d | 369 | chirpInt=brkMonRate/imotorRPM; // brkMonRate=3.6/.0019/.02=94736.8 --> 1 chirp per Wh |
TickTock | 148:6e3b9135fad2 | 370 | chirpInt/=canRXmsg.data[6]; |
TickTock | 140:ab3e94eb0227 | 371 | } |
TickTock | 140:ab3e94eb0227 | 372 | } |
TickTock | 140:ab3e94eb0227 | 373 | } |
TickTock | 13:62e0f7f39ff5 | 374 | } |
TickTock | 37:fea2c1d52c5f | 375 | } |
TickTock | 13:62e0f7f39ff5 | 376 | } |
TickTock | 13:62e0f7f39ff5 | 377 | |
garygid | 87:46ac3f2519d6 | 378 | //----------------------------- |
TickTock | 13:62e0f7f39ff5 | 379 | void logTS () { |
TickTock | 13:62e0f7f39ff5 | 380 | CANMessage tsMsg; |
TickTock | 13:62e0f7f39ff5 | 381 | unsigned long secs = time(NULL); // seconds past 12:00:00 AM 1 Jan 1900 |
garygid | 69:6bfdfc002036 | 382 | // NOTE: In Mbed, I believe that this is seconds past start of 1970, not 1900 |
garygid | 69:6bfdfc002036 | 383 | // but this is good, since seconds past 1970 is what CAN-Do expects. GG - Date Time |
TickTock | 13:62e0f7f39ff5 | 384 | tsMsg.id=0xfff; |
TickTock | 13:62e0f7f39ff5 | 385 | tsMsg.len=0xf; |
garygid | 69:6bfdfc002036 | 386 | tsMsg.data[0]=secs&0xff; |
TickTock | 13:62e0f7f39ff5 | 387 | tsMsg.data[1]=(secs>>8)&0xff; |
TickTock | 13:62e0f7f39ff5 | 388 | tsMsg.data[2]=(secs>>16)&0xff; |
garygid | 69:6bfdfc002036 | 389 | tsMsg.data[3]=(secs>>24)&0xff; |
garygid | 69:6bfdfc002036 | 390 | tsMsg.data[4]=0; // 0xff; gg - Date Time |
garygid | 69:6bfdfc002036 | 391 | tsMsg.data[5]=0; // 0xff; for CAN-Do |
garygid | 69:6bfdfc002036 | 392 | tsMsg.data[6]=0; // 0xff; |
TickTock | 13:62e0f7f39ff5 | 393 | tsMsg.data[7]=0xff; |
garygid | 69:6bfdfc002036 | 394 | logCan(0,tsMsg); // Date-Time |
garygid | 69:6bfdfc002036 | 395 | } |
garygid | 69:6bfdfc002036 | 396 | |
TickTock | 93:c2402e8cd0e2 | 397 | void logEvent (char * errMsg) { |
garygid | 69:6bfdfc002036 | 398 | // log CAN-Do 8-character Pseudo Message |
garygid | 69:6bfdfc002036 | 399 | CANMessage tsMsg; |
garygid | 69:6bfdfc002036 | 400 | tsMsg.id=0xffe; // pseudo Message to CAN-Do log |
garygid | 69:6bfdfc002036 | 401 | tsMsg.len=0xf; |
garygid | 69:6bfdfc002036 | 402 | int iMsgLen = strlen(errMsg); |
garygid | 69:6bfdfc002036 | 403 | // 8 character message compatible with CAN-Do |
garygid | 69:6bfdfc002036 | 404 | for(int i=0; i<8; i++){ |
garygid | 69:6bfdfc002036 | 405 | tsMsg.data[i]=' '; |
garygid | 69:6bfdfc002036 | 406 | if( i < iMsgLen ) tsMsg.data[i]=errMsg[i]; |
garygid | 69:6bfdfc002036 | 407 | } |
garygid | 69:6bfdfc002036 | 408 | logCan(0,tsMsg); // FFE Comment Message |
TickTock | 13:62e0f7f39ff5 | 409 | } |
TickTock | 13:62e0f7f39ff5 | 410 | |
TickTock | 78:a383971fe02f | 411 | void sendReq() { |
TickTock | 78:a383971fe02f | 412 | static char data[8] = {0x02, 0x21, 0x01, 0xff, 0xff, 0xff, 0xff, 0xff}; |
TickTock | 78:a383971fe02f | 413 | if(reqMsgCnt<99){ |
TickTock | 78:a383971fe02f | 414 | switch (reqMsgCnt){ |
TickTock | 124:0d622967b764 | 415 | case BatDataBaseG1: |
TickTock | 138:a2f5af85ed0d | 416 | can2.monitor(false); // set to active mode |
TickTock | 138:a2f5af85ed0d | 417 | can2SleepMode = 0; // enable TX |
TickTock | 79:68f0dd8d1f19 | 418 | data[0]=0x02; //change to request group 1 |
TickTock | 78:a383971fe02f | 419 | data[1]=0x21; |
TickTock | 78:a383971fe02f | 420 | data[2]=0x01; |
TickTock | 78:a383971fe02f | 421 | break; |
TickTock | 124:0d622967b764 | 422 | case BatDataBaseG2: // group 1 has 6 frames |
TickTock | 79:68f0dd8d1f19 | 423 | data[0]=0x02; //change to request group 2 (cp data) |
TickTock | 78:a383971fe02f | 424 | data[1]=0x21; |
TickTock | 78:a383971fe02f | 425 | data[2]=0x02; |
TickTock | 78:a383971fe02f | 426 | break; |
TickTock | 124:0d622967b764 | 427 | case BatDataBaseG3: // group 2 has 29 frames |
TickTock | 79:68f0dd8d1f19 | 428 | data[0]=0x02; //change to request group 3 |
TickTock | 78:a383971fe02f | 429 | data[1]=0x21; |
TickTock | 78:a383971fe02f | 430 | data[2]=0x03; |
TickTock | 78:a383971fe02f | 431 | break; |
TickTock | 124:0d622967b764 | 432 | case BatDataBaseG4: // group 3 has 5 frames |
TickTock | 79:68f0dd8d1f19 | 433 | data[0]=0x02; //change to request group 4 (temperature) |
TickTock | 78:a383971fe02f | 434 | data[1]=0x21; |
TickTock | 78:a383971fe02f | 435 | data[2]=0x04; |
TickTock | 78:a383971fe02f | 436 | break; |
TickTock | 124:0d622967b764 | 437 | case BatDataBaseG5: // group 4 has 3 frames |
TickTock | 79:68f0dd8d1f19 | 438 | data[0]=0x02; //change to request group 5 |
TickTock | 78:a383971fe02f | 439 | data[1]=0x21; |
TickTock | 78:a383971fe02f | 440 | data[2]=0x05; |
TickTock | 78:a383971fe02f | 441 | break; |
TickTock | 124:0d622967b764 | 442 | case BatDataBaseG6: // group 4 has 3 frames |
TickTock | 124:0d622967b764 | 443 | data[0]=0x02; //change to request group 5 |
TickTock | 121:553faf139a20 | 444 | data[1]=0x21; |
TickTock | 121:553faf139a20 | 445 | data[2]=0x06; |
TickTock | 121:553faf139a20 | 446 | break; |
TickTock | 124:0d622967b764 | 447 | case BatDataBaseG7: // group 5 has 11 frames |
TickTock | 78:a383971fe02f | 448 | reqMsgCnt = 99; |
TickTock | 138:a2f5af85ed0d | 449 | can2SleepMode = VP230Sleep; // disable TX |
TickTock | 138:a2f5af85ed0d | 450 | can2.monitor(true); // set to snoop mode |
TickTock | 79:68f0dd8d1f19 | 451 | msgReq.detach(); // stop ticker |
TickTock | 78:a383971fe02f | 452 | default: |
TickTock | 78:a383971fe02f | 453 | data[0]=0x30; //change to request next line message |
TickTock | 78:a383971fe02f | 454 | data[1]=0x01; |
TickTock | 78:a383971fe02f | 455 | data[2]=0x00; |
TickTock | 78:a383971fe02f | 456 | } |
TickTock | 138:a2f5af85ed0d | 457 | can2.write(CANMessage(0x79b, data, 8)); |
TickTock | 78:a383971fe02f | 458 | reqMsgCnt++; |
TickTock | 78:a383971fe02f | 459 | } |
TickTock | 78:a383971fe02f | 460 | } |
TickTock | 78:a383971fe02f | 461 | |
TickTock | 138:a2f5af85ed0d | 462 | void sendTempReq(){ |
TickTock | 138:a2f5af85ed0d | 463 | //Requests ambient and cabin temperature |
TickTock | 138:a2f5af85ed0d | 464 | char data[8] = {0x03, 0x22, 0x11, 0x5d, 0xff, 0xff, 0xff, 0xff}; |
TickTock | 138:a2f5af85ed0d | 465 | can2.monitor(false); // set to active mode |
TickTock | 138:a2f5af85ed0d | 466 | can2SleepMode = 0; // enable TX |
TickTock | 138:a2f5af85ed0d | 467 | can2.write(CANMessage(0x797, data, 8)); |
TickTock | 138:a2f5af85ed0d | 468 | can2SleepMode = VP230Sleep; // disable TX |
TickTock | 138:a2f5af85ed0d | 469 | } |
TickTock | 138:a2f5af85ed0d | 470 | |
TickTock | 78:a383971fe02f | 471 | void autoPollISR(){ |
TickTock | 138:a2f5af85ed0d | 472 | //sendTempReq(); |
TickTock | 78:a383971fe02f | 473 | reqMsgCnt = 0; //reset message counter |
TickTock | 124:0d622967b764 | 474 | msgReq.attach(&sendReq,0.015); |
TickTock | 13:62e0f7f39ff5 | 475 | } |
TickTock | 13:62e0f7f39ff5 | 476 | |
TickTock | 36:dbd39c315258 | 477 | void playbackISR() { //Used for autoplayback |
TickTock | 36:dbd39c315258 | 478 | step=true; |
TickTock | 36:dbd39c315258 | 479 | } |
TickTock | 36:dbd39c315258 | 480 | |
TickTock | 13:62e0f7f39ff5 | 481 | void recieve1() { |
TickTock | 13:62e0f7f39ff5 | 482 | CANMessage msg1; |
TickTock | 13:62e0f7f39ff5 | 483 | can1.read(msg1); |
garygid | 69:6bfdfc002036 | 484 | |
TickTock | 132:08748a67280a | 485 | secsNoEvCanMsg=0; // reset deadman switch |
garygid | 69:6bfdfc002036 | 486 | if( ZeroSecTick ) { ZeroSecTick = false; logTS(); } // gg - 0-second EV bus |
TickTock | 106:f016912a03db | 487 | if(msg1.id>0) { |
TickTock | 106:f016912a03db | 488 | logCan(1, msg1); // EVcan Message Received |
TickTock | 106:f016912a03db | 489 | led1 = !led1; |
TickTock | 106:f016912a03db | 490 | } |
TickTock | 13:62e0f7f39ff5 | 491 | } |
TickTock | 13:62e0f7f39ff5 | 492 | |
TickTock | 13:62e0f7f39ff5 | 493 | void recieve2() { |
TickTock | 13:62e0f7f39ff5 | 494 | CANMessage msg2; |
TickTock | 13:62e0f7f39ff5 | 495 | can2.read(msg2); |
garygid | 69:6bfdfc002036 | 496 | |
TickTock | 132:08748a67280a | 497 | secsNoCarCanMsg=0; // reset deadman switch |
TickTock | 134:ad243e4f1a17 | 498 | if( ZeroSecTick ) { ZeroSecTick = false; logTS(); } // gg - 0-second CAR bus |
TickTock | 106:f016912a03db | 499 | if(msg2.id>0) { |
TickTock | 106:f016912a03db | 500 | logCan(2, msg2); // CARcan Message Received |
TickTock | 106:f016912a03db | 501 | led2 = !led2; |
TickTock | 106:f016912a03db | 502 | } |
TickTock | 13:62e0f7f39ff5 | 503 | } |
TickTock | 13:62e0f7f39ff5 | 504 | |
TickTock | 22:a43df3905863 | 505 | unsigned char buttonX(unsigned short X, unsigned char columns) { |
TickTock | 22:a43df3905863 | 506 | unsigned char val = X*columns/320; |
TickTock | 22:a43df3905863 | 507 | return val; |
TickTock | 22:a43df3905863 | 508 | } |
TickTock | 22:a43df3905863 | 509 | |
TickTock | 22:a43df3905863 | 510 | unsigned char buttonY(unsigned short Y, unsigned char rows) { |
TickTock | 22:a43df3905863 | 511 | unsigned short val = Y*rows/240; |
TickTock | 22:a43df3905863 | 512 | return val; |
TickTock | 22:a43df3905863 | 513 | } |
TickTock | 23:cd03f9c3395e | 514 | |
TickTock | 23:cd03f9c3395e | 515 | void saveConfig(){ |
TickTock | 23:cd03f9c3395e | 516 | FILE *cfile; |
TickTock | 147:e0f1c84c62a6 | 517 | FIL efile; // external usb file |
TickTock | 147:e0f1c84c62a6 | 518 | FRESULT sfr; // external file access flags |
TickTock | 147:e0f1c84c62a6 | 519 | unsigned int bytesRW; |
TickTock | 147:e0f1c84c62a6 | 520 | const int bufSize = 2048; |
TickTock | 147:e0f1c84c62a6 | 521 | char buffer[bufSize]; |
TickTock | 150:ef46ce63345c | 522 | char sTemp[16]; |
TickTock | 174:cd27e80f197d | 523 | |
TickTock | 174:cd27e80f197d | 524 | tt.set_font((unsigned char*) Arial12x12); |
TickTock | 174:cd27e80f197d | 525 | tt.background(Blue); |
TickTock | 174:cd27e80f197d | 526 | tt.foreground(Yellow); |
TickTock | 174:cd27e80f197d | 527 | tt.locate(0,10); |
TickTock | 174:cd27e80f197d | 528 | tt.cls(); |
TickTock | 174:cd27e80f197d | 529 | |
TickTock | 150:ef46ce63345c | 530 | printMsg("Saving local config file.\n"); |
TickTock | 174:cd27e80f197d | 531 | printf("Saving local config file.\n"); |
TickTock | 99:c05abf8e1cdc | 532 | cfile = fopen("/local/config.txt", "w"); |
TickTock | 174:cd27e80f197d | 533 | fprintf(cfile,"format 11\r\n"); |
TickTock | 23:cd03f9c3395e | 534 | fprintf(cfile,"x0_off %d\r\n",tt.x0_off); |
TickTock | 23:cd03f9c3395e | 535 | fprintf(cfile,"y0_off %d\r\n",tt.y0_off); |
TickTock | 23:cd03f9c3395e | 536 | fprintf(cfile,"x0_pp %d\r\n",tt.x0_pp); |
TickTock | 23:cd03f9c3395e | 537 | fprintf(cfile,"y0_pp %d\r\n",tt.y0_pp); |
TickTock | 23:cd03f9c3395e | 538 | fprintf(cfile,"x1_off %d\r\n",tt.x1_off); |
TickTock | 23:cd03f9c3395e | 539 | fprintf(cfile,"y1_off %d\r\n",tt.y1_off); |
TickTock | 23:cd03f9c3395e | 540 | fprintf(cfile,"x1_pp %d\r\n",tt.x1_pp); |
TickTock | 23:cd03f9c3395e | 541 | fprintf(cfile,"y1_pp %d\r\n",tt.y1_pp); |
TickTock | 23:cd03f9c3395e | 542 | fprintf(cfile,"x_mid %d\r\n",tt.x_mid); |
TickTock | 158:059abeb44ba1 | 543 | if ((dMode[0]==configScreen)||(dMode[0]==config2Screen)) |
TickTock | 147:e0f1c84c62a6 | 544 | fprintf(cfile,"dMode0 %d\r\n",mainScreen); |
TickTock | 147:e0f1c84c62a6 | 545 | else |
TickTock | 26:462ccb580472 | 546 | fprintf(cfile,"dMode0 %d\r\n",dMode[0]); |
TickTock | 158:059abeb44ba1 | 547 | if ((dMode[1]==configScreen)||(dMode[1]==config2Screen)) |
TickTock | 147:e0f1c84c62a6 | 548 | fprintf(cfile,"dMode1 %d\r\n",mainScreen); |
TickTock | 147:e0f1c84c62a6 | 549 | else |
TickTock | 26:462ccb580472 | 550 | fprintf(cfile,"dMode1 %d\r\n",dMode[1]); |
TickTock | 35:5acbd8a64a89 | 551 | fprintf(cfile,"ledHi %4.3f\r\n",ledHi); |
TickTock | 35:5acbd8a64a89 | 552 | fprintf(cfile,"ledLo %4.3f\r\n",ledLo); |
TickTock | 35:5acbd8a64a89 | 553 | fprintf(cfile,"pollInt %d\r\n",pollInt); |
TickTock | 35:5acbd8a64a89 | 554 | fprintf(cfile,"scale12V %4.2f\r\n",scale12V); |
TickTock | 48:d1ce92104a1f | 555 | fprintf(cfile,"skin %d\r\n",skin); |
TickTock | 50:83d5864c64a0 | 556 | fprintf(cfile,"dtePeriod %d\r\n",dtePeriod); |
garygid | 87:46ac3f2519d6 | 557 | fprintf(cfile,"DebugMode %d\r\n",(debugMode?1:0)); |
leafman | 98:9f8bab96edff | 558 | fprintf(cfile,"metric %d\r\n",(metric?1:0)); |
leafman | 98:9f8bab96edff | 559 | fprintf(cfile, "firmware %d\r\n", fwCount ); |
TickTock | 131:0d926c080a65 | 560 | fprintf(cfile,"showHealth %d\r\n",(showHealth?1:0)); |
TickTock | 159:577e9d015693 | 561 | fprintf(cfile,"brakeMon %d\r\n",(heaterMon?4:0)+(brakeMon?2:0)+(regenMon?1:0)); |
TickTock | 174:cd27e80f197d | 562 | fprintf(cfile,"brkMonRate %2.1f\r\n", (float) brkMonRate/94737 ); |
TickTock | 174:cd27e80f197d | 563 | fprintf(cfile,"brkMonThr %2.1f\r\n", (float) brkMonThr/1895); |
TickTock | 149:e9739523109f | 564 | for(char i=0;i<8;i++){ |
TickTock | 150:ef46ce63345c | 565 | sprintf(sTemp,"usrMsgId %04x",uMsgId[i]); |
TickTock | 150:ef46ce63345c | 566 | fprintf(cfile,"%s\r\n", sTemp ); |
TickTock | 149:e9739523109f | 567 | } |
TickTock | 152:a4d66901785d | 568 | fprintf(cfile,"modelYear %d\r\n",modelYear); |
TickTock | 152:a4d66901785d | 569 | fprintf(cfile,"autoSync %d\r\n",(autoSync?1:0)); |
TickTock | 170:7ee98e3611bc | 570 | fprintf(cfile,"kWperGid %4.3f\r\n",kWperGid); |
TickTock | 23:cd03f9c3395e | 571 | fclose(cfile); |
TickTock | 147:e0f1c84c62a6 | 572 | |
TickTock | 147:e0f1c84c62a6 | 573 | // Make copy of CONFIG.TXT |
TickTock | 150:ef46ce63345c | 574 | printMsg("Saving CONFIG.BAK.\n"); |
TickTock | 147:e0f1c84c62a6 | 575 | cfile = fopen("/local/CONFIG.TXT", "r"); |
TickTock | 147:e0f1c84c62a6 | 576 | sfr = f_open(&efile,"CONFIG.BAK",FA_WRITE|FA_CREATE_NEW); |
TickTock | 147:e0f1c84c62a6 | 577 | if((cfile != NULL)&&(sfr == FR_OK)){ |
TickTock | 174:cd27e80f197d | 578 | printf("Copy config file to USB\n"); |
TickTock | 147:e0f1c84c62a6 | 579 | while (!feof(cfile)) |
TickTock | 147:e0f1c84c62a6 | 580 | { |
TickTock | 147:e0f1c84c62a6 | 581 | bytesRW=fread(buffer, 1, bufSize, cfile); |
TickTock | 147:e0f1c84c62a6 | 582 | sfr=f_write(&efile,&buffer,bytesRW,&bytesRW); |
TickTock | 147:e0f1c84c62a6 | 583 | } |
TickTock | 147:e0f1c84c62a6 | 584 | fflush(cfile); |
TickTock | 147:e0f1c84c62a6 | 585 | fclose(cfile); |
TickTock | 147:e0f1c84c62a6 | 586 | f_close(&efile); |
TickTock | 147:e0f1c84c62a6 | 587 | } |
TickTock | 150:ef46ce63345c | 588 | |
TickTock | 150:ef46ce63345c | 589 | // Make copy of ehist.cny |
TickTock | 150:ef46ce63345c | 590 | printMsg("Saving ehist.bak.\n"); |
TickTock | 150:ef46ce63345c | 591 | cfile = fopen("/local/ehist.cny", "r"); |
TickTock | 150:ef46ce63345c | 592 | sfr = f_open(&efile,"ehist.bak",FA_WRITE|FA_CREATE_NEW); |
TickTock | 150:ef46ce63345c | 593 | if((cfile != NULL)&&(sfr == FR_OK)){ |
TickTock | 174:cd27e80f197d | 594 | printf("Copy ehist file to USB\n"); |
TickTock | 150:ef46ce63345c | 595 | while (!feof(cfile)) |
TickTock | 150:ef46ce63345c | 596 | { |
TickTock | 150:ef46ce63345c | 597 | bytesRW=fread(buffer, 1, bufSize, cfile); |
TickTock | 150:ef46ce63345c | 598 | sfr=f_write(&efile,&buffer,bytesRW,&bytesRW); |
TickTock | 150:ef46ce63345c | 599 | } |
TickTock | 150:ef46ce63345c | 600 | fflush(cfile); |
TickTock | 150:ef46ce63345c | 601 | fclose(cfile); |
TickTock | 150:ef46ce63345c | 602 | f_close(&efile); |
TickTock | 150:ef46ce63345c | 603 | } |
TickTock | 174:cd27e80f197d | 604 | wait(3); |
TickTock | 23:cd03f9c3395e | 605 | } |
TickTock | 23:cd03f9c3395e | 606 | |
TickTock | 111:d1559bb25c43 | 607 | void readConfig(){ |
TickTock | 23:cd03f9c3395e | 608 | FILE *cfile; |
TickTock | 152:a4d66901785d | 609 | int ff,readHex,readBool; |
TickTock | 150:ef46ce63345c | 610 | char sTemp[16]; |
TickTock | 174:cd27e80f197d | 611 | float readFloat; |
TickTock | 131:0d926c080a65 | 612 | |
TickTock | 23:cd03f9c3395e | 613 | cfile = fopen("/local/config.txt", "r"); |
TickTock | 23:cd03f9c3395e | 614 | if (cfile==NULL){ // if doesn't exist --> create |
TickTock | 116:5cd72bae7c12 | 615 | printMsg("No config file found.\n"); // no config file |
TickTock | 116:5cd72bae7c12 | 616 | printMsg("Calibrating touch screen.\n"); // calibrating |
TickTock | 23:cd03f9c3395e | 617 | //tt.setcal(5570, 34030, 80, 108, 33700, 5780, 82, 108, 32500);// bypass calibration using my values |
TickTock | 23:cd03f9c3395e | 618 | tt.calibrate(); // run touchscreen calibration routine |
garygid | 58:4d06288d75a2 | 619 | // NOTE: calibrates screen 1 first, then screen 0. |
TickTock | 23:cd03f9c3395e | 620 | saveConfig(); |
TickTock | 23:cd03f9c3395e | 621 | } else { |
TickTock | 102:fd19f777a0b4 | 622 | ledHi = 0.8; |
TickTock | 150:ef46ce63345c | 623 | ledLo = 0.3; |
TickTock | 102:fd19f777a0b4 | 624 | pollInt = 60; |
TickTock | 48:d1ce92104a1f | 625 | scale12V = 16.2; |
TickTock | 170:7ee98e3611bc | 626 | kWperGid=0.080; |
TickTock | 48:d1ce92104a1f | 627 | skin = ttSkin; |
leafman | 98:9f8bab96edff | 628 | fscanf(cfile, "format %d\r\n", &ff ); |
leafman | 98:9f8bab96edff | 629 | fscanf(cfile, "x0_off %d\r\n", &tt.x0_off ); |
leafman | 98:9f8bab96edff | 630 | fscanf(cfile, "y0_off %d\r\n", &tt.y0_off ); |
leafman | 98:9f8bab96edff | 631 | fscanf(cfile, "x0_pp %d\r\n", &tt.x0_pp ); |
leafman | 98:9f8bab96edff | 632 | fscanf(cfile, "y0_pp %d\r\n", &tt.y0_pp ); |
leafman | 98:9f8bab96edff | 633 | fscanf(cfile, "x1_off %d\r\n", &tt.x1_off ); |
leafman | 98:9f8bab96edff | 634 | fscanf(cfile, "y1_off %d\r\n", &tt.y1_off ); |
leafman | 98:9f8bab96edff | 635 | fscanf(cfile, "x1_pp %d\r\n", &tt.x1_pp ); |
leafman | 98:9f8bab96edff | 636 | fscanf(cfile, "y1_pp %d\r\n", &tt.y1_pp ); |
leafman | 98:9f8bab96edff | 637 | fscanf(cfile, "x_mid %d\r\n", &tt.x_mid ); |
leafman | 98:9f8bab96edff | 638 | fscanf(cfile, "dMode0 %d\r\n", &dMode[0] ); |
leafman | 98:9f8bab96edff | 639 | fscanf(cfile, "dMode1 %d\r\n", &dMode[1] ); |
TickTock | 35:5acbd8a64a89 | 640 | if(ff>1){ |
leafman | 98:9f8bab96edff | 641 | fscanf(cfile, "ledHi %f\r\n", &ledHi ); |
leafman | 98:9f8bab96edff | 642 | fscanf(cfile, "ledLo %f\r\n", &ledLo ); |
leafman | 98:9f8bab96edff | 643 | fscanf(cfile, "pollInt %d\r\n", &pollInt ); |
leafman | 98:9f8bab96edff | 644 | fscanf(cfile, "scale12V %f\r\n", &scale12V ); |
TickTock | 48:d1ce92104a1f | 645 | } |
TickTock | 48:d1ce92104a1f | 646 | if(ff>2){ |
leafman | 98:9f8bab96edff | 647 | fscanf(cfile, "skin %d\r\n", &skin ); |
leafman | 98:9f8bab96edff | 648 | fscanf(cfile, "dtePeriod %d\r\n", &dtePeriod ); |
TickTock | 35:5acbd8a64a89 | 649 | } |
garygid | 87:46ac3f2519d6 | 650 | if(ff>3){ |
TickTock | 152:a4d66901785d | 651 | fscanf(cfile, "DebugMode %d\r\n", &readBool ); |
TickTock | 152:a4d66901785d | 652 | debugMode = (bool)readBool; |
leafman | 98:9f8bab96edff | 653 | } |
leafman | 98:9f8bab96edff | 654 | if(ff>4) { |
TickTock | 152:a4d66901785d | 655 | fscanf(cfile, "metric %d\r\n", &readBool ); |
TickTock | 152:a4d66901785d | 656 | metric = (bool)readBool; // This will get re-assigned based on dash selection |
TickTock | 152:a4d66901785d | 657 | fscanf(cfile, "firmware %d\r\n", &fwCount ); |
TickTock | 35:5acbd8a64a89 | 658 | } |
TickTock | 131:0d926c080a65 | 659 | if(ff>5){ |
TickTock | 152:a4d66901785d | 660 | fscanf(cfile, "showHealth %d\r\n", &readBool ); |
TickTock | 152:a4d66901785d | 661 | showHealth = (bool)readBool; |
TickTock | 131:0d926c080a65 | 662 | } |
TickTock | 140:ab3e94eb0227 | 663 | if(ff>6){ |
TickTock | 155:f31006516956 | 664 | fscanf(cfile, "brakeMon %d\r\n", &readBool ); |
TickTock | 155:f31006516956 | 665 | brakeMon = (bool)(readBool&1); |
TickTock | 155:f31006516956 | 666 | regenMon = (bool)(readBool&2); |
TickTock | 159:577e9d015693 | 667 | heaterMon = (bool)(readBool&4); |
TickTock | 174:cd27e80f197d | 668 | if(ff>10){ |
TickTock | 174:cd27e80f197d | 669 | fscanf(cfile, "brkMonRate %f\r\n", &readFloat ); |
TickTock | 174:cd27e80f197d | 670 | brkMonRate = 94737 * readFloat; |
TickTock | 174:cd27e80f197d | 671 | fscanf(cfile, "brkMonThr %f\r\n", &readFloat ); |
TickTock | 174:cd27e80f197d | 672 | brkMonThr = 1895 * readFloat; |
TickTock | 174:cd27e80f197d | 673 | }else{ |
TickTock | 174:cd27e80f197d | 674 | fscanf(cfile, "brkMonRate %d\r\n", &brkMonRate ); |
TickTock | 174:cd27e80f197d | 675 | fscanf(cfile, "brkMonThr %d\r\n", &brkMonThr); |
TickTock | 174:cd27e80f197d | 676 | brkMonRate = 378948; |
TickTock | 174:cd27e80f197d | 677 | brkMonThr = 1895; |
TickTock | 174:cd27e80f197d | 678 | } |
TickTock | 140:ab3e94eb0227 | 679 | } |
TickTock | 149:e9739523109f | 680 | if(ff>7){ |
TickTock | 149:e9739523109f | 681 | for(char i=0;i<8;i++){ |
TickTock | 150:ef46ce63345c | 682 | fscanf(cfile, "usrMsgId %s\r\n", &sTemp ); |
TickTock | 152:a4d66901785d | 683 | sscanf(sTemp,"%x", &readHex); |
TickTock | 152:a4d66901785d | 684 | uMsgId[i]=readHex; |
TickTock | 149:e9739523109f | 685 | } |
TickTock | 149:e9739523109f | 686 | } |
TickTock | 152:a4d66901785d | 687 | if(ff>8){ |
TickTock | 152:a4d66901785d | 688 | fscanf(cfile, "modelYear %d\r\n", &modelYear); |
TickTock | 158:059abeb44ba1 | 689 | fscanf(cfile, "autoSync %d\r\n", &readBool); |
TickTock | 152:a4d66901785d | 690 | autoSync = (bool)readBool; |
TickTock | 152:a4d66901785d | 691 | } |
TickTock | 170:7ee98e3611bc | 692 | if(ff>9){ |
TickTock | 170:7ee98e3611bc | 693 | fscanf(cfile, "kWperGid %f\r\n", &kWperGid ); |
TickTock | 170:7ee98e3611bc | 694 | } |
TickTock | 23:cd03f9c3395e | 695 | fclose(cfile); |
TickTock | 174:cd27e80f197d | 696 | if((ff>11)||(ff<1)||(ledHi<0.1)||(scale12V<10)||(tt.x_mid<16000)||(ledHi>1)||(ledLo>1)||(dMode[0]>maxScreens)||(dMode[1]>maxScreens)){ //Sanity check a few things |
TickTock | 148:6e3b9135fad2 | 697 | //Something wrong. Load defaults |
TickTock | 174:cd27e80f197d | 698 | printMsg("Invalid config file. Loading defaults.\n"); |
TickTock | 148:6e3b9135fad2 | 699 | wait(3); |
TickTock | 174:cd27e80f197d | 700 | ff=11; |
TickTock | 148:6e3b9135fad2 | 701 | tt.x0_off=5732; |
TickTock | 148:6e3b9135fad2 | 702 | tt.y0_off=34009; |
TickTock | 148:6e3b9135fad2 | 703 | tt.x0_pp=77; |
TickTock | 148:6e3b9135fad2 | 704 | tt.y0_pp=106; |
TickTock | 148:6e3b9135fad2 | 705 | tt.x1_off=33955; |
TickTock | 148:6e3b9135fad2 | 706 | tt.y1_off=6310; |
TickTock | 148:6e3b9135fad2 | 707 | tt.x1_pp=80; |
TickTock | 148:6e3b9135fad2 | 708 | tt.y1_pp=104; |
TickTock | 148:6e3b9135fad2 | 709 | tt.x_mid=31986; |
TickTock | 152:a4d66901785d | 710 | dMode[0]=2; |
TickTock | 152:a4d66901785d | 711 | dMode[1]=4; |
TickTock | 148:6e3b9135fad2 | 712 | ledHi=0.800; |
TickTock | 150:ef46ce63345c | 713 | ledLo=0.300; |
TickTock | 148:6e3b9135fad2 | 714 | pollInt=300; |
TickTock | 148:6e3b9135fad2 | 715 | scale12V=16.20; |
TickTock | 148:6e3b9135fad2 | 716 | skin=0; |
TickTock | 148:6e3b9135fad2 | 717 | dtePeriod=14; |
TickTock | 148:6e3b9135fad2 | 718 | debugMode=false; |
TickTock | 148:6e3b9135fad2 | 719 | metric=false; |
TickTock | 148:6e3b9135fad2 | 720 | fwCount=1; |
TickTock | 148:6e3b9135fad2 | 721 | showHealth=true; |
TickTock | 148:6e3b9135fad2 | 722 | brakeMon=true; |
TickTock | 155:f31006516956 | 723 | regenMon=true; |
TickTock | 159:577e9d015693 | 724 | heaterMon=true; |
TickTock | 174:cd27e80f197d | 725 | brkMonRate=378947; // 4Wh per chirp |
TickTock | 174:cd27e80f197d | 726 | brkMonThr=1895; // 1Wh per second |
TickTock | 149:e9739523109f | 727 | uMsgId[0]=0x5103; |
TickTock | 149:e9739523109f | 728 | uMsgId[1]=0x50a3; |
TickTock | 149:e9739523109f | 729 | uMsgId[2]=0x54a4; |
TickTock | 149:e9739523109f | 730 | uMsgId[3]=0x54b4; |
TickTock | 149:e9739523109f | 731 | uMsgId[4]=0x54c0; |
TickTock | 149:e9739523109f | 732 | uMsgId[5]=0x55b4; |
TickTock | 149:e9739523109f | 733 | uMsgId[6]=0x0000; |
TickTock | 149:e9739523109f | 734 | uMsgId[7]=0x0000; |
TickTock | 152:a4d66901785d | 735 | modelYear=2011; |
TickTock | 152:a4d66901785d | 736 | autoSync=false; |
TickTock | 170:7ee98e3611bc | 737 | kWperGid=0.080; |
TickTock | 148:6e3b9135fad2 | 738 | } |
TickTock | 174:cd27e80f197d | 739 | if(ff<11){//If not latest format, save as latest format |
TickTock | 35:5acbd8a64a89 | 740 | saveConfig(); |
TickTock | 174:cd27e80f197d | 741 | printMsg("Config file format updated.\n"); // config format updates |
TickTock | 48:d1ce92104a1f | 742 | } |
TickTock | 116:5cd72bae7c12 | 743 | printMsg("Config file loaded.\n"); // config file loaded |
TickTock | 23:cd03f9c3395e | 744 | } |
TickTock | 23:cd03f9c3395e | 745 | } |
TickTock | 25:ddf0ec209f03 | 746 | |
TickTock | 25:ddf0ec209f03 | 747 | void upDate(unsigned char field, bool upDownBar){ |
TickTock | 25:ddf0ec209f03 | 748 | struct tm t; // pointer to a static tm structure |
TickTock | 25:ddf0ec209f03 | 749 | time_t seconds ; |
TickTock | 25:ddf0ec209f03 | 750 | seconds = time(NULL); |
TickTock | 25:ddf0ec209f03 | 751 | t = *localtime(&seconds) ; |
TickTock | 25:ddf0ec209f03 | 752 | switch(field){ |
TickTock | 25:ddf0ec209f03 | 753 | case 0: // year |
TickTock | 25:ddf0ec209f03 | 754 | if (upDownBar) { |
TickTock | 25:ddf0ec209f03 | 755 | t.tm_year = t.tm_year+1; |
TickTock | 25:ddf0ec209f03 | 756 | } else { |
TickTock | 25:ddf0ec209f03 | 757 | t.tm_year = t.tm_year-1; |
TickTock | 25:ddf0ec209f03 | 758 | } |
TickTock | 25:ddf0ec209f03 | 759 | break; |
TickTock | 25:ddf0ec209f03 | 760 | case 1: // month |
TickTock | 25:ddf0ec209f03 | 761 | if (upDownBar) { |
TickTock | 152:a4d66901785d | 762 | t.tm_mon = (t.tm_mon<11)?t.tm_mon+1:0; |
TickTock | 25:ddf0ec209f03 | 763 | } else { |
TickTock | 152:a4d66901785d | 764 | t.tm_mon = (t.tm_mon>0)?t.tm_mon-1:11; |
TickTock | 25:ddf0ec209f03 | 765 | } |
TickTock | 25:ddf0ec209f03 | 766 | break; |
TickTock | 25:ddf0ec209f03 | 767 | case 2: // day |
TickTock | 25:ddf0ec209f03 | 768 | if (upDownBar) { |
TickTock | 25:ddf0ec209f03 | 769 | t.tm_mday = (t.tm_mday<31)?t.tm_mday+1:1; |
TickTock | 25:ddf0ec209f03 | 770 | } else { |
TickTock | 152:a4d66901785d | 771 | t.tm_mday = (t.tm_mday>1)?t.tm_mday-1:31; |
TickTock | 25:ddf0ec209f03 | 772 | } |
TickTock | 25:ddf0ec209f03 | 773 | break; |
TickTock | 25:ddf0ec209f03 | 774 | case 3: // hour |
TickTock | 25:ddf0ec209f03 | 775 | if (upDownBar) { |
TickTock | 25:ddf0ec209f03 | 776 | t.tm_hour = (t.tm_hour<23)?t.tm_hour+1:0; |
TickTock | 25:ddf0ec209f03 | 777 | } else { |
TickTock | 152:a4d66901785d | 778 | t.tm_hour = (t.tm_hour>0)?t.tm_hour-1:23; |
TickTock | 25:ddf0ec209f03 | 779 | } |
TickTock | 25:ddf0ec209f03 | 780 | break; |
TickTock | 25:ddf0ec209f03 | 781 | case 4: // minute |
TickTock | 25:ddf0ec209f03 | 782 | if (upDownBar) { |
TickTock | 25:ddf0ec209f03 | 783 | t.tm_min = (t.tm_min<59)?t.tm_min+1:0; |
TickTock | 25:ddf0ec209f03 | 784 | } else { |
TickTock | 152:a4d66901785d | 785 | t.tm_min = (t.tm_min>0)?t.tm_min-1:59; |
TickTock | 25:ddf0ec209f03 | 786 | } |
TickTock | 25:ddf0ec209f03 | 787 | break; |
TickTock | 25:ddf0ec209f03 | 788 | case 5: // second |
TickTock | 25:ddf0ec209f03 | 789 | if (upDownBar) { |
TickTock | 25:ddf0ec209f03 | 790 | t.tm_sec = (t.tm_sec<59)?t.tm_sec+1:0; |
TickTock | 25:ddf0ec209f03 | 791 | } else { |
TickTock | 152:a4d66901785d | 792 | t.tm_sec = (t.tm_sec>0)?t.tm_sec-1:59; |
TickTock | 25:ddf0ec209f03 | 793 | } |
TickTock | 25:ddf0ec209f03 | 794 | break; |
TickTock | 25:ddf0ec209f03 | 795 | default: |
TickTock | 25:ddf0ec209f03 | 796 | break; |
TickTock | 25:ddf0ec209f03 | 797 | } |
TickTock | 25:ddf0ec209f03 | 798 | set_time(mktime(&t)); |
TickTock | 25:ddf0ec209f03 | 799 | } |
TickTock | 25:ddf0ec209f03 | 800 | |
TickTock | 153:e94cfe3c339c | 801 | bool syncDateTime(){ // doesn't work on MY2013 |
TickTock | 152:a4d66901785d | 802 | struct tm t; // pointer to a static tm structure |
TickTock | 152:a4d66901785d | 803 | time_t seconds ; |
TickTock | 152:a4d66901785d | 804 | CANMessage msg; |
TickTock | 160:905fe45ed54b | 805 | static unsigned char lastHour, numMatched; |
TickTock | 152:a4d66901785d | 806 | seconds = time(NULL); |
TickTock | 152:a4d66901785d | 807 | t = *localtime(&seconds); |
TickTock | 153:e94cfe3c339c | 808 | if(modelYear<2013){ //MY2011,2012 |
TickTock | 153:e94cfe3c339c | 809 | msg = lastMsg[indexLastMsg[0x5fa]]; |
TickTock | 153:e94cfe3c339c | 810 | t.tm_mon = (msg.data[5]>>4)-1; |
TickTock | 153:e94cfe3c339c | 811 | t.tm_mday = msg.data[2]>>3; |
TickTock | 153:e94cfe3c339c | 812 | msg = lastMsg[indexLastMsg[0x5fb]]; |
TickTock | 153:e94cfe3c339c | 813 | //t.tm_year = msg.data[1]; // Have not figured out where the year is |
TickTock | 153:e94cfe3c339c | 814 | msg = lastMsg[indexLastMsg[0x5fc]]; |
TickTock | 153:e94cfe3c339c | 815 | t.tm_hour = msg.data[0]>>3; |
TickTock | 153:e94cfe3c339c | 816 | t.tm_min = (msg.data[1]<<4&0x30)+(msg.data[2]>>4); |
TickTock | 153:e94cfe3c339c | 817 | t.tm_sec = msg.data[1]>>2; |
TickTock | 153:e94cfe3c339c | 818 | }else{ // model year 2013 or higher |
TickTock | 153:e94cfe3c339c | 819 | msg = lastMsg[indexLastMsg[0x5f9]]; |
TickTock | 153:e94cfe3c339c | 820 | t.tm_hour = msg.data[5]>>3; |
TickTock | 153:e94cfe3c339c | 821 | t.tm_min = msg.data[4]; |
TickTock | 153:e94cfe3c339c | 822 | msg = lastMsg[indexLastMsg[0x509]]; |
TickTock | 153:e94cfe3c339c | 823 | t.tm_sec = msg.data[2]>>2; |
TickTock | 153:e94cfe3c339c | 824 | } |
TickTock | 160:905fe45ed54b | 825 | if(t.tm_hour==lastHour){ //filter |
TickTock | 160:905fe45ed54b | 826 | numMatched++; |
TickTock | 160:905fe45ed54b | 827 | }else{ |
TickTock | 160:905fe45ed54b | 828 | numMatched=0; |
TickTock | 160:905fe45ed54b | 829 | } |
TickTock | 160:905fe45ed54b | 830 | lastHour=t.tm_hour; |
TickTock | 160:905fe45ed54b | 831 | if((numMatched>5)&&(t.tm_mon>=0)&&(t.tm_mon<12)&&(t.tm_mday>0)&&(t.tm_mday<32)&&(t.tm_hour>=0)&&(t.tm_hour<24)&&(t.tm_min>=0)&&(t.tm_min<60)&&(t.tm_sec>=0)&&(t.tm_sec<60)){ // sanity check result before using |
TickTock | 153:e94cfe3c339c | 832 | set_time(mktime(&t)); |
TickTock | 160:905fe45ed54b | 833 | numMatched=0; |
TickTock | 153:e94cfe3c339c | 834 | return(true); |
TickTock | 153:e94cfe3c339c | 835 | }else{ |
TickTock | 153:e94cfe3c339c | 836 | return(false); |
TickTock | 153:e94cfe3c339c | 837 | } |
TickTock | 153:e94cfe3c339c | 838 | |
TickTock | 152:a4d66901785d | 839 | } |
TickTock | 152:a4d66901785d | 840 | |
TickTock | 39:eef8beac7411 | 841 | void logPackVoltages() { // Turbo3 - routine to dump CP values to text file |
TickTock | 39:eef8beac7411 | 842 | char sTemp[40]; |
TickTock | 39:eef8beac7411 | 843 | struct tm t; // pointer to a static tm structure |
TickTock | 39:eef8beac7411 | 844 | short unsigned max, min, jv, i, bd; |
TickTock | 39:eef8beac7411 | 845 | unsigned avg; |
TickTock | 119:0e2b641e98a2 | 846 | unsigned short gids, SOC, packV_x2; |
TickTock | 140:ab3e94eb0227 | 847 | unsigned long odo; |
TickTock | 119:0e2b641e98a2 | 848 | signed short packA_x2; |
TickTock | 39:eef8beac7411 | 849 | time_t seconds ; |
TickTock | 39:eef8beac7411 | 850 | |
TickTock | 39:eef8beac7411 | 851 | CANMessage msg; |
TickTock | 39:eef8beac7411 | 852 | |
TickTock | 39:eef8beac7411 | 853 | seconds = time(NULL); // Turbo3 |
TickTock | 39:eef8beac7411 | 854 | t = *localtime(&seconds) ; // Turbo3 |
TickTock | 39:eef8beac7411 | 855 | |
TickTock | 39:eef8beac7411 | 856 | msg = lastMsg[indexLastMsg[0x5bc]]; //Get gids |
TickTock | 39:eef8beac7411 | 857 | gids = (msg.data[0]<<2)+(msg.data[1]>>6); |
TickTock | 140:ab3e94eb0227 | 858 | msg = lastMsg[indexLastMsg[0x5c5]]; //Get odometer |
TickTock | 140:ab3e94eb0227 | 859 | odo = (msg.data[1]<16)+(msg.data[2]<<8)+msg.data[3]; |
TickTock | 39:eef8beac7411 | 860 | msg = lastMsg[indexLastMsg[0x55b]]; //Get SOC |
TickTock | 39:eef8beac7411 | 861 | SOC = (msg.data[0]<<2)+(msg.data[1]>>6); |
TickTock | 39:eef8beac7411 | 862 | msg = lastMsg[indexLastMsg[0x1db]]; //Get pack volts |
TickTock | 119:0e2b641e98a2 | 863 | packV_x2 = (msg.data[2]<<2)+(msg.data[3]>>6); |
TickTock | 119:0e2b641e98a2 | 864 | packA_x2 = (msg.data[0]<<3)+(msg.data[1]>>5); |
TickTock | 119:0e2b641e98a2 | 865 | if (packA_x2 & 0x400) packA_x2 |= 0xf800; |
TickTock | 39:eef8beac7411 | 866 | |
TickTock | 39:eef8beac7411 | 867 | max=0; |
TickTock | 39:eef8beac7411 | 868 | min=9999; |
TickTock | 39:eef8beac7411 | 869 | avg=0; |
TickTock | 92:935adef49ea4 | 870 | for(i=0; i<96; i++) { |
TickTock | 124:0d622967b764 | 871 | bd=(battData[BatDataBaseG2*7+i*2+3]<<8)+battData[BatDataBaseG2*7+i*2+4]; |
TickTock | 39:eef8beac7411 | 872 | avg+=bd; |
TickTock | 39:eef8beac7411 | 873 | if(bd>max) max=bd; |
TickTock | 39:eef8beac7411 | 874 | if(bd<min) min=bd; |
TickTock | 39:eef8beac7411 | 875 | } |
TickTock | 39:eef8beac7411 | 876 | avg /= 96; |
TickTock | 39:eef8beac7411 | 877 | if(min<3713) { |
TickTock | 39:eef8beac7411 | 878 | jv=avg-(max-avg)*1.5; |
TickTock | 39:eef8beac7411 | 879 | } else { // Only compute judgement value if min cellpair meets <= 3712mV requirement |
TickTock | 39:eef8beac7411 | 880 | jv=0; |
TickTock | 39:eef8beac7411 | 881 | } |
TickTock | 39:eef8beac7411 | 882 | |
TickTock | 110:ffddff3ad2f2 | 883 | FIL bfile; |
TickTock | 110:ffddff3ad2f2 | 884 | FRESULT bfr; |
TickTock | 110:ffddff3ad2f2 | 885 | bfr = f_open(&bfile,"batvolt.txt",FA_WRITE|FA_OPEN_ALWAYS); |
TickTock | 110:ffddff3ad2f2 | 886 | if(bfr==FR_OK) { |
TickTock | 110:ffddff3ad2f2 | 887 | f_lseek(&bfile,0xffffffff); // go to end of file to append |
TickTock | 39:eef8beac7411 | 888 | strftime(sTemp, 40, "%a %m/%d/%Y %X", &t); |
TickTock | 110:ffddff3ad2f2 | 889 | f_printf(&bfile,"%s,",sTemp); |
TickTock | 140:ab3e94eb0227 | 890 | sprintf(sTemp,"%d,%d,%5.1f%%,%5.1f,%5.1f,%d,%d,%d,%d,%d",odo,gids,(float)SOC/10,(float)packV_x2/2,(float)packA_x2/2,max,min,avg,max-min,jv); |
TickTock | 110:ffddff3ad2f2 | 891 | f_printf(&bfile,"%s,",sTemp); |
TickTock | 124:0d622967b764 | 892 | f_printf(&bfile,"%d,%d,%d,%d,",(battData[(BatDataBaseG4*7)+ 3]<<8)+battData[(BatDataBaseG4*7)+ 4],battData[(BatDataBaseG4*7)+ 5],(battData[(BatDataBaseG4*7)+ 6]<<8)+battData[(BatDataBaseG4*7)+ 7],battData[(BatDataBaseG4*7)+ 8]); |
TickTock | 124:0d622967b764 | 893 | f_printf(&bfile,"%d,%d,%d,%d", (battData[(BatDataBaseG4*7)+ 9]<<8)+battData[(BatDataBaseG4*7)+10],battData[(BatDataBaseG4*7)+11],(battData[(BatDataBaseG4*7)+12]<<8)+battData[(BatDataBaseG4*7)+13],battData[(BatDataBaseG4*7)+14]); |
TickTock | 108:29b5a760adc2 | 894 | for(i=0; i<96; i++) { |
TickTock | 124:0d622967b764 | 895 | bd=(battData[BatDataBaseG2*7+i*2+3]<<8)+battData[BatDataBaseG2*7+i*2+4]; |
TickTock | 110:ffddff3ad2f2 | 896 | f_printf(&bfile,",%d",bd); |
TickTock | 108:29b5a760adc2 | 897 | } |
TickTock | 110:ffddff3ad2f2 | 898 | f_printf(&bfile,"\r\n"); |
TickTock | 110:ffddff3ad2f2 | 899 | f_close(&bfile); |
TickTock | 110:ffddff3ad2f2 | 900 | } |
TickTock | 108:29b5a760adc2 | 901 | logCP=false; |
TickTock | 108:29b5a760adc2 | 902 | showCP=true; |
TickTock | 108:29b5a760adc2 | 903 | } |
TickTock | 108:29b5a760adc2 | 904 | |
TickTock | 108:29b5a760adc2 | 905 | void tripLog() { // Daily log |
TickTock | 110:ffddff3ad2f2 | 906 | char sTemp[40]; |
TickTock | 155:f31006516956 | 907 | unsigned char ambient; |
TickTock | 108:29b5a760adc2 | 908 | struct tm t; // pointer to a static tm structure |
TickTock | 108:29b5a760adc2 | 909 | short unsigned max, min, jv, i, bd; |
TickTock | 108:29b5a760adc2 | 910 | unsigned avg; |
TickTock | 119:0e2b641e98a2 | 911 | unsigned short gids, SOC, packV_x2; |
TickTock | 140:ab3e94eb0227 | 912 | unsigned long odo; |
TickTock | 119:0e2b641e98a2 | 913 | signed short packA_x2; |
TickTock | 39:eef8beac7411 | 914 | time_t seconds ; |
TickTock | 39:eef8beac7411 | 915 | |
TickTock | 39:eef8beac7411 | 916 | CANMessage msg; |
TickTock | 39:eef8beac7411 | 917 | |
TickTock | 39:eef8beac7411 | 918 | seconds = time(NULL); // Turbo3 |
TickTock | 39:eef8beac7411 | 919 | t = *localtime(&seconds) ; // Turbo3 |
TickTock | 39:eef8beac7411 | 920 | |
TickTock | 155:f31006516956 | 921 | msg = lastMsg[indexLastMsg[0x54c]]; //Get ambient |
TickTock | 155:f31006516956 | 922 | ambient = msg.data[6]-56; |
TickTock | 39:eef8beac7411 | 923 | msg = lastMsg[indexLastMsg[0x5bc]]; //Get gids |
TickTock | 39:eef8beac7411 | 924 | gids = (msg.data[0]<<2)+(msg.data[1]>>6); |
TickTock | 140:ab3e94eb0227 | 925 | msg = lastMsg[indexLastMsg[0x5c5]]; //Get odometer |
TickTock | 140:ab3e94eb0227 | 926 | odo = (msg.data[1]<16)+(msg.data[2]<<8)+msg.data[3]; |
TickTock | 39:eef8beac7411 | 927 | msg = lastMsg[indexLastMsg[0x55b]]; //Get SOC |
TickTock | 39:eef8beac7411 | 928 | SOC = (msg.data[0]<<2)+(msg.data[1]>>6); |
TickTock | 39:eef8beac7411 | 929 | msg = lastMsg[indexLastMsg[0x1db]]; //Get pack volts |
TickTock | 119:0e2b641e98a2 | 930 | packV_x2 = (msg.data[2]<<2)+(msg.data[3]>>6); |
TickTock | 119:0e2b641e98a2 | 931 | packA_x2 = (msg.data[0]<<3)+(msg.data[1]>>5); |
TickTock | 119:0e2b641e98a2 | 932 | if (packA_x2 & 0x400) packA_x2 |= 0xf800; |
TickTock | 39:eef8beac7411 | 933 | |
TickTock | 39:eef8beac7411 | 934 | max=0; |
TickTock | 39:eef8beac7411 | 935 | min=9999; |
TickTock | 39:eef8beac7411 | 936 | avg=0; |
TickTock | 39:eef8beac7411 | 937 | for(i=0; i<96; i++) { |
TickTock | 124:0d622967b764 | 938 | bd=(battData[BatDataBaseG2*7+i*2+3]<<8)+battData[BatDataBaseG2*7+i*2+4]; |
TickTock | 39:eef8beac7411 | 939 | avg+=bd; |
TickTock | 39:eef8beac7411 | 940 | if(bd>max) max=bd; |
TickTock | 39:eef8beac7411 | 941 | if(bd<min) min=bd; |
TickTock | 39:eef8beac7411 | 942 | } |
TickTock | 39:eef8beac7411 | 943 | avg /= 96; |
TickTock | 39:eef8beac7411 | 944 | if(min<3713) { |
TickTock | 39:eef8beac7411 | 945 | jv=avg-(max-avg)*1.5; |
TickTock | 39:eef8beac7411 | 946 | } else { // Only compute judgement value if min cellpair meets <= 3712mV requirement |
TickTock | 39:eef8beac7411 | 947 | jv=0; |
TickTock | 39:eef8beac7411 | 948 | } |
TickTock | 39:eef8beac7411 | 949 | |
TickTock | 110:ffddff3ad2f2 | 950 | FIL bfile; |
TickTock | 110:ffddff3ad2f2 | 951 | FRESULT bfr; |
TickTock | 111:d1559bb25c43 | 952 | bfr = f_open(&bfile,"triplog.txt",FA_WRITE|FA_OPEN_ALWAYS); |
TickTock | 110:ffddff3ad2f2 | 953 | if(bfr==FR_OK) { |
TickTock | 110:ffddff3ad2f2 | 954 | f_lseek(&bfile,0xffffffff); // go to end of file to append |
TickTock | 170:7ee98e3611bc | 955 | // timestamp, odometer, accV, gids, SOC, SOH2, Ah, Vbatt, Ibatt, Rest, maxCP, minCP, avgCO, maxCP-minCP, CVLI_jv, miles_trip, kWh_trip, CCkWh_trip, ambient, T1raw, T1, T2raw, T2, T3raw, T3, T4raw, T4, CP1, CP2, ... , CP96 |
TickTock | 39:eef8beac7411 | 956 | strftime(sTemp, 40, "%a %m/%d/%Y %X", &t); |
TickTock | 110:ffddff3ad2f2 | 957 | f_printf(&bfile,"%s,",sTemp); |
TickTock | 170:7ee98e3611bc | 958 | sprintf(sTemp,"%d,%3.1f,%d,%5.1f%%,%5.1f%%,%4.2f,%5.1f,%4.1f,%4.3f,%d,%d,%d,%d,%d,%4.1f,%4.2f,%4.2f",odo,accV,gids,(float)SOC/10, (float)SOH2_x100/100,(float)Ah_x10000/10000,(float)packV_x2/2,(float)packA_x2/2,Resr,max,min,avg,max-min,jv,miles_trip[0],kWh_trip[0],CCkWh_trip[0]); |
TickTock | 155:f31006516956 | 959 | f_printf(&bfile,"%s,%d,",sTemp,ambient); |
TickTock | 124:0d622967b764 | 960 | f_printf(&bfile,"%d,%d,%d,%d,",(battData[(BatDataBaseG4*7)+ 3]<<8)+battData[(BatDataBaseG4*7)+ 4],battData[(BatDataBaseG4*7)+ 5],(battData[(BatDataBaseG4*7)+ 6]<<8)+battData[(BatDataBaseG4*7)+ 7],battData[(BatDataBaseG4*7)+ 8]); |
TickTock | 124:0d622967b764 | 961 | f_printf(&bfile,"%d,%d,%d,%d", (battData[(BatDataBaseG4*7)+ 9]<<8)+battData[(BatDataBaseG4*7)+10],battData[(BatDataBaseG4*7)+11],(battData[(BatDataBaseG4*7)+12]<<8)+battData[(BatDataBaseG4*7)+13],battData[(BatDataBaseG4*7)+14]); |
TickTock | 142:c1a11d6f181c | 962 | for(i=0; i<96; i++) { |
TickTock | 124:0d622967b764 | 963 | bd=(battData[BatDataBaseG2*7+i*2+3]<<8)+battData[BatDataBaseG2*7+i*2+4]; |
TickTock | 110:ffddff3ad2f2 | 964 | f_printf(&bfile,",%d",bd); |
TickTock | 142:c1a11d6f181c | 965 | } |
TickTock | 110:ffddff3ad2f2 | 966 | f_printf(&bfile,"\r\n"); |
TickTock | 110:ffddff3ad2f2 | 967 | f_close(&bfile); |
TickTock | 39:eef8beac7411 | 968 | } |
TickTock | 39:eef8beac7411 | 969 | } |
TickTock | 25:ddf0ec209f03 | 970 | |
leafman | 98:9f8bab96edff | 971 | //LM - updates firmware off a usb key, eliminating the need to plug |
leafman | 98:9f8bab96edff | 972 | //the CANary into a computer for updates. |
leafman | 98:9f8bab96edff | 973 | void updateFirmware() |
leafman | 98:9f8bab96edff | 974 | { |
TickTock | 143:88b5155622a5 | 975 | FIL efile; // external usb file |
TickTock | 111:d1559bb25c43 | 976 | FRESULT sfr; // external file access flags |
TickTock | 111:d1559bb25c43 | 977 | unsigned int bytesRW; |
TickTock | 111:d1559bb25c43 | 978 | char sTemp[40]; |
TickTock | 131:0d926c080a65 | 979 | const int bufSize = 2048; |
TickTock | 131:0d926c080a65 | 980 | char buffer[bufSize]; |
TickTock | 143:88b5155622a5 | 981 | FILE *lfile; |
TickTock | 131:0d926c080a65 | 982 | |
TickTock | 158:059abeb44ba1 | 983 | tt.set_font((unsigned char*) Arial12x12); |
TickTock | 151:3047ebb3c9a8 | 984 | tt.background(Blue); |
TickTock | 151:3047ebb3c9a8 | 985 | tt.foreground(Yellow); |
TickTock | 151:3047ebb3c9a8 | 986 | tt.locate(0,10); |
TickTock | 151:3047ebb3c9a8 | 987 | tt.cls(); |
TickTock | 150:ef46ce63345c | 988 | |
TickTock | 143:88b5155622a5 | 989 | sfr = f_open(&efile,"firmware.bin",FA_READ|FA_OPEN_EXISTING); |
TickTock | 111:d1559bb25c43 | 990 | if(sfr != FR_OK) |
TickTock | 99:c05abf8e1cdc | 991 | { |
TickTock | 137:70853cf5a30f | 992 | printf("Couldn't find firmware.bin\n"); |
TickTock | 108:29b5a760adc2 | 993 | wait(3); |
TickTock | 100:63a7456fc972 | 994 | lastDMode[whichTouched]=99;//force refresh |
TickTock | 99:c05abf8e1cdc | 995 | return; |
TickTock | 99:c05abf8e1cdc | 996 | } |
leafman | 98:9f8bab96edff | 997 | fwCount ++; |
TickTock | 151:3047ebb3c9a8 | 998 | printf("Saving config.\n"); |
TickTock | 148:6e3b9135fad2 | 999 | saveConfig(); |
leafman | 98:9f8bab96edff | 1000 | //delete all bin files in /local |
leafman | 98:9f8bab96edff | 1001 | DIR *dir; |
leafman | 98:9f8bab96edff | 1002 | struct dirent *ent; |
TickTock | 151:3047ebb3c9a8 | 1003 | printf("Starting update.\n"); |
TickTock | 151:3047ebb3c9a8 | 1004 | printf("Deleting old firmware files.\n"); |
leafman | 98:9f8bab96edff | 1005 | if ((dir = opendir ("/local/")) != NULL) { |
TickTock | 109:3e6f0e8fca0d | 1006 | // print all the files and directories within directory |
leafman | 98:9f8bab96edff | 1007 | while ((ent = readdir (dir)) != NULL) { |
leafman | 98:9f8bab96edff | 1008 | //printf("FILE: %s\n",ent->d_name); |
leafman | 98:9f8bab96edff | 1009 | char dest[4] = ""; |
leafman | 98:9f8bab96edff | 1010 | strncat(dest, &ent->d_name[strlen(ent->d_name)-3],3); |
leafman | 98:9f8bab96edff | 1011 | dest[0] = tolower(dest[0]); |
leafman | 98:9f8bab96edff | 1012 | dest[1] = tolower(dest[1]); |
leafman | 98:9f8bab96edff | 1013 | dest[2] = tolower(dest[2]); |
leafman | 98:9f8bab96edff | 1014 | if(strcmp(dest,"bin")==0) |
leafman | 98:9f8bab96edff | 1015 | { |
leafman | 98:9f8bab96edff | 1016 | sprintf(sTemp,"/local/%s",ent->d_name); |
leafman | 98:9f8bab96edff | 1017 | int result = remove(sTemp); |
TickTock | 151:3047ebb3c9a8 | 1018 | printf("deleted: %s\n",ent->d_name); |
leafman | 98:9f8bab96edff | 1019 | } |
leafman | 98:9f8bab96edff | 1020 | } |
leafman | 98:9f8bab96edff | 1021 | closedir (dir); |
leafman | 98:9f8bab96edff | 1022 | } else { |
TickTock | 109:3e6f0e8fca0d | 1023 | //could not open directory |
TickTock | 151:3047ebb3c9a8 | 1024 | printf("Couldn't open folder.\n"); |
TickTock | 160:905fe45ed54b | 1025 | wait(3); |
leafman | 98:9f8bab96edff | 1026 | return; |
leafman | 98:9f8bab96edff | 1027 | } |
TickTock | 151:3047ebb3c9a8 | 1028 | printf("Copying new firmware.\n"); |
leafman | 98:9f8bab96edff | 1029 | //Copy the new firmware from usb->local |
TickTock | 131:0d926c080a65 | 1030 | //The newest bin file is the one that is used by the mbed |
leafman | 98:9f8bab96edff | 1031 | sprintf(sTemp,"/local/fw%d.bin",fwCount); |
TickTock | 151:3047ebb3c9a8 | 1032 | printf("Writing %s.\n",sTemp); |
TickTock | 160:905fe45ed54b | 1033 | //wait(2); |
TickTock | 143:88b5155622a5 | 1034 | lfile = fopen(sTemp, "wb"); |
TickTock | 143:88b5155622a5 | 1035 | if(lfile == NULL) |
leafman | 98:9f8bab96edff | 1036 | { |
TickTock | 151:3047ebb3c9a8 | 1037 | printf("Couldn't open destination.\n"); |
TickTock | 160:905fe45ed54b | 1038 | wait(3); |
leafman | 98:9f8bab96edff | 1039 | return; |
leafman | 98:9f8bab96edff | 1040 | } |
TickTock | 97:a25940fd7b5b | 1041 | |
TickTock | 143:88b5155622a5 | 1042 | while (!f_eof(&efile)) |
leafman | 98:9f8bab96edff | 1043 | { |
TickTock | 143:88b5155622a5 | 1044 | sfr=f_read(&efile,&buffer,bufSize,&bytesRW); |
TickTock | 143:88b5155622a5 | 1045 | fwrite(buffer, 1, bytesRW, lfile); |
leafman | 98:9f8bab96edff | 1046 | } |
leafman | 98:9f8bab96edff | 1047 | |
TickTock | 143:88b5155622a5 | 1048 | fflush(lfile); |
TickTock | 143:88b5155622a5 | 1049 | fclose(lfile); |
TickTock | 143:88b5155622a5 | 1050 | f_close(&efile); |
TickTock | 151:3047ebb3c9a8 | 1051 | printf("Succesful.\n\n"); |
TickTock | 152:a4d66901785d | 1052 | printf("Rebooting in 5 seconds.\n"); |
TickTock | 152:a4d66901785d | 1053 | wait(5); |
leafman | 98:9f8bab96edff | 1054 | //Now run new firmware |
TickTock | 111:d1559bb25c43 | 1055 | mbed_reset(); |
TickTock | 99:c05abf8e1cdc | 1056 | } |
TickTock | 108:29b5a760adc2 | 1057 | |
TickTock | 169:84d790ac18a2 | 1058 | void updateConfig() |
TickTock | 169:84d790ac18a2 | 1059 | { |
TickTock | 169:84d790ac18a2 | 1060 | FIL efile; // external usb file |
TickTock | 169:84d790ac18a2 | 1061 | FRESULT sfr; // external file access flags |
TickTock | 169:84d790ac18a2 | 1062 | unsigned int bytesRW; |
TickTock | 169:84d790ac18a2 | 1063 | const int bufSize = 2048; |
TickTock | 169:84d790ac18a2 | 1064 | char buffer[bufSize]; |
TickTock | 169:84d790ac18a2 | 1065 | FILE *lfile; |
TickTock | 169:84d790ac18a2 | 1066 | |
TickTock | 169:84d790ac18a2 | 1067 | tt.set_font((unsigned char*) Arial12x12); |
TickTock | 169:84d790ac18a2 | 1068 | tt.background(Blue); |
TickTock | 169:84d790ac18a2 | 1069 | tt.foreground(Yellow); |
TickTock | 169:84d790ac18a2 | 1070 | tt.locate(0,10); |
TickTock | 169:84d790ac18a2 | 1071 | tt.cls(); |
TickTock | 174:cd27e80f197d | 1072 | |
TickTock | 174:cd27e80f197d | 1073 | printMsg("Copy config file from USB\n"); |
TickTock | 169:84d790ac18a2 | 1074 | // Check for config file on USB drive |
TickTock | 169:84d790ac18a2 | 1075 | sfr = f_open(&efile,"CONFIG.TXT",FA_READ|FA_OPEN_EXISTING); |
TickTock | 169:84d790ac18a2 | 1076 | if(sfr == FR_OK){ |
TickTock | 169:84d790ac18a2 | 1077 | printf("Copy config file from USB\n"); |
TickTock | 169:84d790ac18a2 | 1078 | lfile = fopen("/local/CONFIG.TXT", "w"); |
TickTock | 169:84d790ac18a2 | 1079 | if(lfile != NULL) { |
TickTock | 169:84d790ac18a2 | 1080 | while (!f_eof(&efile)){ |
TickTock | 169:84d790ac18a2 | 1081 | sfr=f_read(&efile,&buffer,bufSize,&bytesRW); |
TickTock | 169:84d790ac18a2 | 1082 | fwrite(buffer, 1, bytesRW, lfile); |
TickTock | 169:84d790ac18a2 | 1083 | } |
TickTock | 169:84d790ac18a2 | 1084 | fflush(lfile); |
TickTock | 169:84d790ac18a2 | 1085 | fclose(lfile); |
TickTock | 169:84d790ac18a2 | 1086 | } |
TickTock | 169:84d790ac18a2 | 1087 | f_close(&efile); |
TickTock | 169:84d790ac18a2 | 1088 | int fwc_tmp = fwCount; |
TickTock | 169:84d790ac18a2 | 1089 | readConfig(); |
TickTock | 169:84d790ac18a2 | 1090 | fwCount = fwc_tmp; // Do no overwrite fwcount when loading new config |
TickTock | 169:84d790ac18a2 | 1091 | } |
TickTock | 169:84d790ac18a2 | 1092 | |
TickTock | 169:84d790ac18a2 | 1093 | // Check for history file on USB drive |
TickTock | 174:cd27e80f197d | 1094 | printMsg("Copy ehist file from USB\n"); |
TickTock | 169:84d790ac18a2 | 1095 | sfr = f_open(&efile,"ehist.cny",FA_READ|FA_OPEN_EXISTING); |
TickTock | 169:84d790ac18a2 | 1096 | if(sfr == FR_OK){ |
TickTock | 169:84d790ac18a2 | 1097 | printf("Copy ehist file from USB\n"); |
TickTock | 169:84d790ac18a2 | 1098 | lfile = fopen("/local/ehist.cny", "w"); |
TickTock | 169:84d790ac18a2 | 1099 | if(lfile != NULL) { |
TickTock | 169:84d790ac18a2 | 1100 | while (!f_eof(&efile)){ |
TickTock | 169:84d790ac18a2 | 1101 | sfr=f_read(&efile,&buffer,bufSize,&bytesRW); |
TickTock | 169:84d790ac18a2 | 1102 | fwrite(buffer, 1, bytesRW, lfile); |
TickTock | 169:84d790ac18a2 | 1103 | } |
TickTock | 169:84d790ac18a2 | 1104 | fflush(lfile); |
TickTock | 169:84d790ac18a2 | 1105 | fclose(lfile); |
TickTock | 169:84d790ac18a2 | 1106 | } |
TickTock | 169:84d790ac18a2 | 1107 | f_close(&efile); |
TickTock | 169:84d790ac18a2 | 1108 | } |
TickTock | 169:84d790ac18a2 | 1109 | printf("Succesful.\n\n"); |
TickTock | 169:84d790ac18a2 | 1110 | wait(5); |
TickTock | 169:84d790ac18a2 | 1111 | } |
TickTock | 169:84d790ac18a2 | 1112 | |
TickTock | 108:29b5a760adc2 | 1113 | bool detectUSB(void){ |
TickTock | 130:1a9d2a6d99ce | 1114 | FIL tfile; // external usb file |
TickTock | 111:d1559bb25c43 | 1115 | bool usbEn = (f_open(&tfile,"usb.det",FA_WRITE|FA_OPEN_ALWAYS)==FR_OK); |
TickTock | 108:29b5a760adc2 | 1116 | if(usbEn){ |
TickTock | 111:d1559bb25c43 | 1117 | f_close(&tfile); |
TickTock | 111:d1559bb25c43 | 1118 | f_unlink("usb.det"); |
TickTock | 111:d1559bb25c43 | 1119 | } |
TickTock | 130:1a9d2a6d99ce | 1120 | return(usbEn); |
TickTock | 108:29b5a760adc2 | 1121 | } |
TickTock | 131:0d926c080a65 | 1122 | |
TickTock | 155:f31006516956 | 1123 | void spkrOff(void){ |
TickTock | 160:905fe45ed54b | 1124 | if(bCount<2){ |
TickTock | 160:905fe45ed54b | 1125 | spkr.period(1.0/bFreq[bCount]); |
TickTock | 160:905fe45ed54b | 1126 | beepOff.attach(&spkrOff, bTime[bCount++]); |
TickTock | 160:905fe45ed54b | 1127 | }else{ |
TickTock | 160:905fe45ed54b | 1128 | spkr=0; |
TickTock | 160:905fe45ed54b | 1129 | dled.period(.001); |
TickTock | 160:905fe45ed54b | 1130 | } |
TickTock | 155:f31006516956 | 1131 | } |
TickTock | 155:f31006516956 | 1132 | |
TickTock | 155:f31006516956 | 1133 | void beep(float freq, float time){ |
TickTock | 155:f31006516956 | 1134 | if (enableSound) { |
TickTock | 155:f31006516956 | 1135 | spkr.period(1.0/freq); |
TickTock | 155:f31006516956 | 1136 | spkr=0.5; |
TickTock | 159:577e9d015693 | 1137 | if(!headlights){ //restore LCD pwm output (Beep pwm interferes with display pwm) |
TickTock | 155:f31006516956 | 1138 | dled = ledHi; |
TickTock | 155:f31006516956 | 1139 | } else { |
TickTock | 155:f31006516956 | 1140 | dled = ledLo; |
TickTock | 155:f31006516956 | 1141 | } |
TickTock | 155:f31006516956 | 1142 | beepOff.attach(&spkrOff, time); |
TickTock | 155:f31006516956 | 1143 | } |
TickTock | 155:f31006516956 | 1144 | } |
TickTock | 155:f31006516956 | 1145 | |
TickTock | 160:905fe45ed54b | 1146 | void beep3(float freq1, float time1, float freq2, float time2, float freq3, float time3){ |
TickTock | 160:905fe45ed54b | 1147 | bFreq[0]=freq2; |
TickTock | 160:905fe45ed54b | 1148 | bTime[0]=time2; |
TickTock | 160:905fe45ed54b | 1149 | bFreq[1]=freq3; |
TickTock | 160:905fe45ed54b | 1150 | bTime[1]=time3; |
TickTock | 160:905fe45ed54b | 1151 | bCount=0; |
TickTock | 160:905fe45ed54b | 1152 | beep(freq1, time1); |
TickTock | 160:905fe45ed54b | 1153 | } |
TickTock | 160:905fe45ed54b | 1154 | |
TickTock | 140:ab3e94eb0227 | 1155 | void chirp(void){ |
TickTock | 140:ab3e94eb0227 | 1156 | static unsigned short counter=0; |
TickTock | 140:ab3e94eb0227 | 1157 | |
TickTock | 140:ab3e94eb0227 | 1158 | if(chirpInt>0){ |
TickTock | 141:cf13a632ddb5 | 1159 | if(++counter>chirpInt){ |
TickTock | 155:f31006516956 | 1160 | beep(1600,0.015); |
TickTock | 140:ab3e94eb0227 | 1161 | counter=0; |
TickTock | 140:ab3e94eb0227 | 1162 | } |
TickTock | 148:6e3b9135fad2 | 1163 | }else{ |
TickTock | 148:6e3b9135fad2 | 1164 | counter=0; |
TickTock | 140:ab3e94eb0227 | 1165 | } |
TickTock | 140:ab3e94eb0227 | 1166 | } |
TickTock | 140:ab3e94eb0227 | 1167 | |
TickTock | 131:0d926c080a65 | 1168 | //Sample CONFIG.TXT |
TickTock | 131:0d926c080a65 | 1169 | /* |
TickTock | 174:cd27e80f197d | 1170 | format 11 |
TickTock | 131:0d926c080a65 | 1171 | x0_off 5732 |
TickTock | 131:0d926c080a65 | 1172 | y0_off 34009 |
TickTock | 131:0d926c080a65 | 1173 | x0_pp 77 |
TickTock | 131:0d926c080a65 | 1174 | y0_pp 106 |
TickTock | 131:0d926c080a65 | 1175 | x1_off 33955 |
TickTock | 131:0d926c080a65 | 1176 | y1_off 6310 |
TickTock | 131:0d926c080a65 | 1177 | x1_pp 80 |
TickTock | 131:0d926c080a65 | 1178 | y1_pp 104 |
TickTock | 131:0d926c080a65 | 1179 | x_mid 31986 |
TickTock | 131:0d926c080a65 | 1180 | dMode0 4 |
TickTock | 131:0d926c080a65 | 1181 | dMode1 2 |
TickTock | 131:0d926c080a65 | 1182 | ledHi 0.800 |
TickTock | 150:ef46ce63345c | 1183 | ledLo 0.300 |
TickTock | 131:0d926c080a65 | 1184 | pollInt 300 |
TickTock | 131:0d926c080a65 | 1185 | scale12V 16.20 |
TickTock | 131:0d926c080a65 | 1186 | skin 0 |
TickTock | 131:0d926c080a65 | 1187 | dtePeriod 14 |
TickTock | 131:0d926c080a65 | 1188 | DebugMode 0 |
TickTock | 144:b0c9d30dd346 | 1189 | metric 0 |
TickTock | 148:6e3b9135fad2 | 1190 | firmware 1 |
TickTock | 131:0d926c080a65 | 1191 | showHealth 1 |
TickTock | 141:cf13a632ddb5 | 1192 | brakeMon 1 |
TickTock | 174:cd27e80f197d | 1193 | brkMonRate 4.0 |
TickTock | 174:cd27e80f197d | 1194 | brkMonThr 1.0 |
TickTock | 150:ef46ce63345c | 1195 | usrMsgId 5103 |
TickTock | 150:ef46ce63345c | 1196 | usrMsgId 50a3 |
TickTock | 150:ef46ce63345c | 1197 | usrMsgId 54a4 |
TickTock | 150:ef46ce63345c | 1198 | usrMsgId 54b4 |
TickTock | 150:ef46ce63345c | 1199 | usrMsgId 54c0 |
TickTock | 150:ef46ce63345c | 1200 | usrMsgId 55b4 |
TickTock | 150:ef46ce63345c | 1201 | usrMsgId 0000 |
TickTock | 150:ef46ce63345c | 1202 | usrMsgId 0000 |
TickTock | 152:a4d66901785d | 1203 | modelYear 2011 |
TickTock | 152:a4d66901785d | 1204 | autoSync 1 |
TickTock | 174:cd27e80f197d | 1205 | kWperGid 0.075 |
TickTock | 150:ef46ce63345c | 1206 | */ |