Tick Tock / Mbed 2 deprecated CANary

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 Tick Tock

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

/media/uploads/TickTock/canary_sch.jpg

/media/uploads/TickTock/canaryr6brd.jpg

For LCD Rev 1.01:

/media/uploads/TickTock/lcdsch.jpg

For VCD Rev 2.00:

/media/uploads/TickTock/lcdr2.jpg

Parts List

qtyinstancepart #packagesupplierDescription
1BAT3Vhttp://www.ebay.com/itm/10x-CR2032-SMD-Battery-Holder-for-CR2032-Battery-/180938057979?pt=LH_DefaultDomain_0&hash=item2a20bfa8fbLithium 2032 coin battery holder
4C1-C4ECST1DC106R6032Tantalium capacitor 10uF
3FC1-FC3ZF1-20-01-T-WThttp://www.samtec.com/cable-systems/idc-ffc/ffc/zero-insertion.aspx20 conductor 1mm pitch flex cable connector (optional)
1FJ-20-R-08.00-4http://www.samtec.com/cable-systems/idc-ffc/ffc/zero-insertion.aspx8\" 20 conductor 1mm pitch flex connector, end reversed (optional)
2H1-H4(DON'T populate H1-H4 headers - solder mbed directly)
1H5http://www.ebay.com/itm/221186042943?ssPageName=STRK:MEWNX:IT&_trksid=p3984.m1497.l26491x12 .1\" pitch header (optional)
1H62x6 .1\" pitch header (optional)
2IC1,IC2VP230LMDSOP8http://www.ebay.com/itm/130488665247?ssPageName=STRK:MEWNX:IT&_trksid=p3984.m1497.l2649canbus transciever
1IC3LM1117-5VSOT2235V regulator
5JP*2 pin .1\" jumper header
1mbedLPC1768http://www.ebay.com/itm/200830573509?ssPageName=STRK:MEWNX:IT&_trksid=p3984.m1497.l2649mbed uC
2Q1,Q22N2222SOT23General purpose NPN transistor
1R1R393M120639K resistor
1R2R103M120610K resistor
4R4-R6R102M12061K resistor
1R3R500M120650 Ohm resistor
2TR1-TR5ZJYS81R5-2PL51TG01http://www.digikey.com/product-detail/en/ZJYS81R5-2PL51T-G01/445-2223-1-ND/765232CM Choke
1Z11N5340BGC1702-15http://www.ebay.com/itm/150878122425?ssPageName=STRK:MEWNX:IT&_trksid=p3984.m1497.l26496V, 5W Zener Diode
1Z1DC-DC conveterhttp://www.ebay.com/itm/251142727849?ssPageName=STRK:MEWNX:IT&_trksid=p3984.m1497.l264912V-7V, 3W DC-DC converter
1X1USBhttp://www.ebay.com/itm/New-Vertical-USB-2-0-A-pcb-connector-socket-USB-A-Type-/300553895292?pt=LH_DefaultDomain_0&hash=item45fa687d7cvertical USB connector
2LCD0,LCD1TFThttp://www.mikroe.com/add-on-boards/display/tft-proto/320x240 LCD with touch screen
1E0Enclosurehttp://www.shapeways.com/model/1077799/canary.html?li=user-profile&materialId=63d printed enclosure

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:

1LED+
2LED-
3RST
4SDI
5WR/SCLK
6CS
7X+
8X-
9Y+
10Y-
11VDD
12GND

If, instead, you have HW REV 2.0, you will need 13 conductors with the following order:

1LED+
2LED-
3RST
4SDI
5RS (SCLK)
6WR (DC)
7CS
8X+
9X-
10Y+
11Y-
12VDD
13GND

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:

/media/uploads/TickTock/lcdtop.jpg /media/uploads/TickTock/lcdbot.jpg

Examples of REV2.00:

/media/uploads/TickTock/rev2front.jpg /media/uploads/TickTock/rev2back.jpg

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.

/media/uploads/TickTock/pcbtop.jpg /media/uploads/TickTock/pcbbot.jpg

Once the PCB is populated, solder the LCDs to the PCB. CS0 connects to the right display and CS1 connects to the left. /media/uploads/TickTock/brddis.jpg

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. /media/uploads/TickTock/dcdcinst2.jpg

Once soldered in place, the DC-DC converter can easily be mounted to the back wall with double sided tape above the battery holder. /media/uploads/TickTock/dcdcinst3.jpg

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.

/media/uploads/TickTock/pcbdone.jpg /media/uploads/TickTock/functioning.jpg

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. /media/uploads/TickTock/enclosure.jpg

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. /media/uploads/TickTock/safety.jpg Installed: /media/uploads/TickTock/installed.jpg

utility.cpp@150:ef46ce63345c, 2013-09-27 (annotated)

Committer:
TickTock
Date:
Fri Sep 27 04:43:41 2013 +0000
Revision:
150:ef46ce63345c
Parent:
149:e9739523109f
Child:
151:3047ebb3c9a8
// Removed air drag comp; // Added user message Id's to the config file; // Added copy of ehist.cny to USB on config save and load if present on firmware update

Who changed what in which revision?

UserRevisionLine numberNew contents of line
TickTock 13:62e0f7f39ff5 1 // utility.cpp
TickTock 13:62e0f7f39ff5 2 #include "utility.h"
TickTock 141:cf13a632ddb5 3 unsigned long brkMonRate = 400000;
TickTock 144:b0c9d30dd346 4 unsigned short brkMonThr = 4000;
TickTock 13:62e0f7f39ff5 5
TickTock 13:62e0f7f39ff5 6 void mbed_reset();
TickTock 22:a43df3905863 7
TickTock 13:62e0f7f39ff5 8 void RTC_IRQHandler() {
TickTock 13:62e0f7f39ff5 9 timer.reset(); // zero ms at the-seconds-tic
TickTock 131:0d926c080a65 10 carCanIdle=(++secsNoCarCanMsg>canTimeout)?true:false;
TickTock 132:08748a67280a 11 evCanIdle=(++secsNoEvCanMsg>canTimeout)?true:false;
TickTock 20:3bf176d14b14 12 userIdle=(++secsNoTouch>userTimeout)?true:false;
TickTock 13:62e0f7f39ff5 13 LPC_RTC->ILR |= (1<<0); // clear interrupt to prepare for next
TickTock 34:4751a8259b18 14 tick=true;
garygid 69:6bfdfc002036 15 // will use this to generate a logTP() just before the next Message received.
garygid 69:6bfdfc002036 16 if( (time(NULL) % 60) == 0) ZeroSecTick = true; // gg - at 0-second of each minute
TickTock 13:62e0f7f39ff5 17 }
TickTock 13:62e0f7f39ff5 18
TickTock 37:fea2c1d52c5f 19 void RTC_Init (void) {
TickTock 13:62e0f7f39ff5 20 LPC_RTC->ILR=0x00; // set up the RTC interrupts
TickTock 13:62e0f7f39ff5 21 LPC_RTC->CIIR=0x01; // interrupts each second
TickTock 13:62e0f7f39ff5 22 LPC_RTC->CCR = 0x01; // Clock enable
TickTock 13:62e0f7f39ff5 23 //NVIC_SetPriority( RTC_IRQn, 10 );
TickTock 13:62e0f7f39ff5 24 NVIC_EnableIRQ( RTC_IRQn );
TickTock 13:62e0f7f39ff5 25 }
TickTock 13:62e0f7f39ff5 26
TickTock 93:c2402e8cd0e2 27 void printMsg (char *msg) {
TickTock 13:62e0f7f39ff5 28 strcpy(displayLog[displayLoc],msg);
TickTock 13:62e0f7f39ff5 29 displayLoc=displayLoc>17?0:displayLoc+1;
TickTock 13:62e0f7f39ff5 30 }
TickTock 13:62e0f7f39ff5 31
TickTock 13:62e0f7f39ff5 32 void touch_ISR(){
TickTock 138:a2f5af85ed0d 33 //LPC_GPIOINT->IO2IntClr = (LPC_GPIOINT->IO2IntStatR | LPC_GPIOINT->IO2IntStatF); // seems to work without so maybe not necessary (performed in InterruptIn handler?)
TickTock 35:5acbd8a64a89 34 touched=true; // just set flag - touch screen algorythm is long and we don't want to block other interrupts
TickTock 13:62e0f7f39ff5 35 }
TickTock 13:62e0f7f39ff5 36
TickTock 13:62e0f7f39ff5 37 unsigned short getTimeStamp() {
TickTock 13:62e0f7f39ff5 38 unsigned short msec = timer.read_ms() ; // read ms from the timer
TickTock 13:62e0f7f39ff5 39 unsigned long secs = time(NULL); // seconds past 12:00:00 AM 1 Jan 1900
TickTock 13:62e0f7f39ff5 40 unsigned short isecs = secs%60 ; // modulo 60 for 0-59 seconds from RTC
TickTock 13:62e0f7f39ff5 41 return ((isecs<<10)+msec) ; // return the two byte time stamp
TickTock 13:62e0f7f39ff5 42 }
TickTock 13:62e0f7f39ff5 43
TickTock 13:62e0f7f39ff5 44 void logCan (char mType, CANMessage canRXmsg) {
TickTock 85:5c27e88b3fbe 45
TickTock 85:5c27e88b3fbe 46 // re-arranged to put static first
TickTock 85:5c27e88b3fbe 47 static unsigned char ii = 0;
TickTock 85:5c27e88b3fbe 48 static unsigned char lasti = 0; // indexindex
TickTock 37:fea2c1d52c5f 49 static unsigned char bdi=0;
TickTock 41:8d4609ea7259 50 static signed short imotorRPM = 0;
TickTock 85:5c27e88b3fbe 51 static unsigned short nLost = 0; // gg - overrun
TickTock 85:5c27e88b3fbe 52
TickTock 83:52b1f330a62d 53 char sTemp[40];
TickTock 92:935adef49ea4 54 unsigned char changed;
TickTock 108:29b5a760adc2 55 unsigned short i,j,k;
TickTock 119:0e2b641e98a2 56 signed short packV_x2;
TickTock 119:0e2b641e98a2 57 signed short packA_x2;
TickTock 40:0e6e71a7323f 58 signed long imWs_x4;
garygid 87:46ac3f2519d6 59 unsigned short ts;
TickTock 85:5c27e88b3fbe 60
garygid 87:46ac3f2519d6 61 if(debugMode||(skin==ggSkin)){
garygid 87:46ac3f2519d6 62 // code to insert actual number of dropped frames for overrun debug - skiped in normal mode to keep logcan short
TickTock 85:5c27e88b3fbe 63 if(logOpen){
TickTock 106:f016912a03db 64 // check to see if buffer is already full (read - write) = 1
TickTock 106:f016912a03db 65 // actually the last buffer location cannot be used because then
TickTock 106:f016912a03db 66 // the buffer would look empty after writePointer++
TickTock 106:f016912a03db 67
TickTock 106:f016912a03db 68 //if (((writePointer+maxBufLen-readPointer)%maxBufLen)>(maxBufLen/16)) // modulo is slow?
TickTock 106:f016912a03db 69
TickTock 106:f016912a03db 70 // pointers are 0 through maxBufLen-1
TickTock 106:f016912a03db 71 if( (readPointer - writePointer) == 1 || (writePointer - readPointer) == (maxBufLen - 1)) {
TickTock 106:f016912a03db 72 // the buffer is "full", so Lose this message
TickTock 85:5c27e88b3fbe 73
TickTock 106:f016912a03db 74 // point to the last-stored message
TickTock 106:f016912a03db 75 int tempWritePointer = writePointer - 1 ;
TickTock 106:f016912a03db 76 if( tempWritePointer < 0 ) tempWritePointer = maxBufLen - 1;
TickTock 106:f016912a03db 77 char strLost[9] ;
TickTock 106:f016912a03db 78
TickTock 106:f016912a03db 79 if( nLost == 0 ) {
TickTock 106:f016912a03db 80 // this is the first message lost
TickTock 106:f016912a03db 81 // and we must overwrite the last message with an FFE comment message
TickTock 106:f016912a03db 82 // So, there will be two messages lost as the comment message is laid in.
TickTock 106:f016912a03db 83 nLost = 2;
TickTock 106:f016912a03db 84 sprintf(strLost,"%s","Lost0002"); // indicate two messages lost
TickTock 85:5c27e88b3fbe 85
TickTock 106:f016912a03db 86 // overlay the last message with a "Lost0002" comment
TickTock 106:f016912a03db 87 writeBuffer[tempWritePointer][0]=0;
TickTock 117:49883c779a74 88 // leave the ts of the overlaid message
TickTock 117:49883c779a74 89 //writeBuffer[tempWritePointer][1]=(ts&0xff00)>>8; // Time Stamp (2 bytes_
TickTock 117:49883c779a74 90 //writeBuffer[tempWritePointer][2]=(ts&0x00ff);
TickTock 106:f016912a03db 91 // force the MsgID to an Event Message
TickTock 106:f016912a03db 92 writeBuffer[tempWritePointer][3]=0xfe; // MsgID, low byte
TickTock 106:f016912a03db 93 writeBuffer[tempWritePointer][4]=0xff; // Len nibble, and MsgID high nibble
TickTock 106:f016912a03db 94 // lay in the "Lost0002" text
TickTock 106:f016912a03db 95 for(i=5;i<13;i++){
TickTock 106:f016912a03db 96 writeBuffer[tempWritePointer][i]= strLost[i-5];
TickTock 85:5c27e88b3fbe 97 }
TickTock 85:5c27e88b3fbe 98 } else {
TickTock 106:f016912a03db 99 // at least one message was previously lost
TickTock 106:f016912a03db 100 // increment the loat counter
TickTock 106:f016912a03db 101 nLost += 1;
garygid 87:46ac3f2519d6 102
TickTock 106:f016912a03db 103 // lay the new count into the comment
TickTock 106:f016912a03db 104 sprintf(strLost,"%04d",nLost);
TickTock 106:f016912a03db 105 for(i=9;i<13;i++){
TickTock 106:f016912a03db 106 writeBuffer[tempWritePointer][i]= strLost[i-9];
TickTock 85:5c27e88b3fbe 107 }
TickTock 106:f016912a03db 108 }
TickTock 106:f016912a03db 109 } else {
TickTock 106:f016912a03db 110 // there is room to insert the message
TickTock 106:f016912a03db 111 // get it inserted quickly
TickTock 106:f016912a03db 112 ts=getTimeStamp();
TickTock 106:f016912a03db 113 writeBuffer[writePointer][0]=mType;
TickTock 106:f016912a03db 114 writeBuffer[writePointer][1]=(ts&0xff00)>>8; // Time Stamp (2 bytes_
TickTock 106:f016912a03db 115 writeBuffer[writePointer][2]=(ts&0x00ff);
TickTock 106:f016912a03db 116 writeBuffer[writePointer][3]=canRXmsg.id&0xff; // MsgID, low byte
TickTock 106:f016912a03db 117 char sLen = canRXmsg.len ;
TickTock 106:f016912a03db 118 writeBuffer[writePointer][4]=(canRXmsg.id>>8)+(sLen<<4); // Len nibble, and MsgID high nibble
TickTock 106:f016912a03db 119 for(i=0;i<8;i++){ // Is there a better way to do this? (writeBuffer[writePointer][i]=canRXmsg.data?)
TickTock 106:f016912a03db 120 if(i<sLen)
TickTock 106:f016912a03db 121 writeBuffer[writePointer][i+5]=canRXmsg.data[i];
TickTock 106:f016912a03db 122 else // i>=sLen
TickTock 106:f016912a03db 123 // force unused data bytes to FF for CAN-Do compatibility
TickTock 106:f016912a03db 124 writeBuffer[writePointer][i+5]=0xFF;
TickTock 85:5c27e88b3fbe 125 }
TickTock 106:f016912a03db 126
TickTock 106:f016912a03db 127 //--------------
TickTock 106:f016912a03db 128 // Note, this is not protected from the interrupt.
TickTock 106:f016912a03db 129 // Due to the nLost code above, this no longer
TickTock 106:f016912a03db 130 // overflows to writePointer = readPointer
TickTock 106:f016912a03db 131 // which would make the buffer look empty
TickTock 106:f016912a03db 132 if (++writePointer >= maxBufLen) {
TickTock 106:f016912a03db 133 writePointer = 0;
TickTock 106:f016912a03db 134 led3 = !led3;
TickTock 106:f016912a03db 135 }
TickTock 106:f016912a03db 136 //--------------
TickTock 106:f016912a03db 137 // log a local message if we had lost messages. gg - logcan
TickTock 106:f016912a03db 138 if( nLost > 0 ) {
TickTock 106:f016912a03db 139 // We previously lost messages that did not get into the buffer
TickTock 106:f016912a03db 140 sprintf(sTemp,"-- Lost %d Messages.\n", nLost);
TickTock 106:f016912a03db 141 printMsg(sTemp); // write buffer overrun
TickTock 106:f016912a03db 142 //spkr.beep(500,0.25);
TickTock 106:f016912a03db 143
TickTock 106:f016912a03db 144 nLost = 0 ;
TickTock 106:f016912a03db 145 }
TickTock 106:f016912a03db 146 //--------------
TickTock 13:62e0f7f39ff5 147 }
TickTock 85:5c27e88b3fbe 148 }
TickTock 92:935adef49ea4 149 }else{ // not debugMode - keep code short
TickTock 85:5c27e88b3fbe 150 if(logOpen){
TickTock 106:f016912a03db 151 NVIC_DisableIRQ(CAN_IRQn); // Block interrupts until write pointer assigned
TickTock 106:f016912a03db 152 int localWritePointer = writePointer++; // create local copy to make logCan reentrant
TickTock 106:f016912a03db 153 // note that the static variables do not prevent safe reentry
TickTock 106:f016912a03db 154 // since they are only used for msgId<0x800 which will never interrupt
TickTock 106:f016912a03db 155 // another msgId<0x800 (both CANbusses are same priority)
TickTock 106:f016912a03db 156 if (writePointer >= maxBufLen) {
TickTock 77:7c136766466c 157 writePointer = 0;
TickTock 77:7c136766466c 158 led3 = !led3;
TickTock 77:7c136766466c 159 }
TickTock 106:f016912a03db 160 NVIC_EnableIRQ(CAN_IRQn); // Unblock interrupts once local pointer set and global pointer incremented
TickTock 106:f016912a03db 161 ts=getTimeStamp();
TickTock 106:f016912a03db 162 writeBuffer[localWritePointer][0]=mType;
TickTock 106:f016912a03db 163 writeBuffer[localWritePointer][1]=(ts&0xff00)>>8;
TickTock 106:f016912a03db 164 writeBuffer[localWritePointer][2]=(ts&0x00ff);
TickTock 106:f016912a03db 165 writeBuffer[localWritePointer][3]=canRXmsg.id&0xff;
TickTock 106:f016912a03db 166 writeBuffer[localWritePointer][4]=(canRXmsg.id>>8)+(canRXmsg.len<<4);
TickTock 106:f016912a03db 167 for(i=5;i<13;i++){ // Is there a better way to do this? (writeBuffer[localWritePointer][5]=canRXmsg.data?)
TickTock 106:f016912a03db 168 writeBuffer[localWritePointer][i]=canRXmsg.data[i-5];
TickTock 106:f016912a03db 169 }
TickTock 75:77bd26829dca 170 if (writePointer==readPointer) {
TickTock 117:49883c779a74 171 // Just caught up to read pointer
TickTock 117:49883c779a74 172 printMsg("Write buffer overrun.\n"); // write buffer overrun
TickTock 77:7c136766466c 173 spkr.beep(500,0.25);
TickTock 13:62e0f7f39ff5 174 }
TickTock 13:62e0f7f39ff5 175 }
TickTock 37:fea2c1d52c5f 176 }
TickTock 40:0e6e71a7323f 177
TickTock 83:52b1f330a62d 178 if(canRXmsg.id<0x800){ // Block FFE and FFF messages
TickTock 83:52b1f330a62d 179 if(indexLastMsg[canRXmsg.id]==0) { //Check if no entry
TickTock 92:935adef49ea4 180 //ii=ii<99?ii+1:0; // Should never wrap - less than 100 different messages ever used
garygid 87:46ac3f2519d6 181 if(ii<99) {
TickTock 92:935adef49ea4 182 //indexLastMsg[canRXmsg.id]=ii; //Create entry if first message
garygid 87:46ac3f2519d6 183 indexLastMsg[canRXmsg.id]=++ii; //Create entry for first MsgID occurance
garygid 87:46ac3f2519d6 184 // ii max is 99 here
garygid 87:46ac3f2519d6 185 } else {
garygid 87:46ac3f2519d6 186 // the ii array is full, more than 100 MsgIDs found
garygid 87:46ac3f2519d6 187 if(ii==99) {
TickTock 92:935adef49ea4 188 ii++; // step to 100 to log only one error
TickTock 116:5cd72bae7c12 189 printMsg("MsgID buffer overrun.\n"); // write buffer overrun
garygid 87:46ac3f2519d6 190 }
TickTock 13:62e0f7f39ff5 191 }
TickTock 13:62e0f7f39ff5 192 }
garygid 87:46ac3f2519d6 193
garygid 87:46ac3f2519d6 194 //----------------
TickTock 85:5c27e88b3fbe 195 if(dMode[0]==changedScreen||dMode[1]==changedScreen){// Skip if not using (for execution speed)
TickTock 83:52b1f330a62d 196 changed=msgChanged[indexLastMsg[canRXmsg.id]];
TickTock 85:5c27e88b3fbe 197 // This is cleared in the main loop when reset button is touched
TickTock 92:935adef49ea4 198 for(i=0;i<8;i++){
TickTock 83:52b1f330a62d 199 if(lastMsg[indexLastMsg[canRXmsg.id]].data[i]!=canRXmsg.data[i]){
TickTock 83:52b1f330a62d 200 changed |= 1<<i;
garygid 80:24f1793171e7 201 }
TickTock 13:62e0f7f39ff5 202 }
TickTock 83:52b1f330a62d 203 msgChanged[indexLastMsg[canRXmsg.id]]=changed;
TickTock 13:62e0f7f39ff5 204 }
garygid 80:24f1793171e7 205
TickTock 83:52b1f330a62d 206 lastMsg[indexLastMsg[canRXmsg.id]]=canRXmsg; //Store in table
garygid 87:46ac3f2519d6 207
garygid 87:46ac3f2519d6 208 //-------------------
TickTock 83:52b1f330a62d 209 //Miscellaneous on-recieve operations below
TickTock 124:0d622967b764 210 if((mType==1)&&(canRXmsg.id==0x7bb)){ // is battery data? Need to store all responses
TickTock 124:0d622967b764 211 if(canRXmsg.data[0]<0x20){
TickTock 115:549410af477d 212 if(canRXmsg.data[3]==1){//Group 1 data
TickTock 124:0d622967b764 213 bdi=BatDataBaseG1; // index offset for Group 1 data
TickTock 115:549410af477d 214 if(debugMode){
TickTock 116:5cd72bae7c12 215 printMsg(" Getting Group 1 data\n");
TickTock 115:549410af477d 216 }
TickTock 115:549410af477d 217
TickTock 115:549410af477d 218 }else if(canRXmsg.data[3]==2){//Group 2 = cellpair data
TickTock 124:0d622967b764 219 bdi=BatDataBaseG2; // index offset for CP data
TickTock 97:a25940fd7b5b 220 if(debugMode){
TickTock 116:5cd72bae7c12 221 printMsg(" Getting cell pair data\n");
TickTock 97:a25940fd7b5b 222 }
garygid 87:46ac3f2519d6 223
TickTock 115:549410af477d 224 }else if(canRXmsg.data[3]==3){//Group 3 data
TickTock 124:0d622967b764 225 bdi=BatDataBaseG3; // index offset for Group 3 data
TickTock 115:549410af477d 226 if(debugMode){
TickTock 116:5cd72bae7c12 227 printMsg(" Getting Group 3 data\n");
TickTock 115:549410af477d 228 }
TickTock 115:549410af477d 229
garygid 87:46ac3f2519d6 230 }else if(canRXmsg.data[3]==4){//Group 4 = temperature data
TickTock 124:0d622967b764 231 bdi=BatDataBaseG4; // index offset for Temperature data
TickTock 97:a25940fd7b5b 232 if(debugMode){
TickTock 116:5cd72bae7c12 233 printMsg(" Getting temperature data\n");
TickTock 97:a25940fd7b5b 234 }
garygid 87:46ac3f2519d6 235
garygid 87:46ac3f2519d6 236 }else if(canRXmsg.data[3]==5){//Group 5 data
TickTock 124:0d622967b764 237 bdi=BatDataBaseG5; // index offset for Group 5 data
TickTock 97:a25940fd7b5b 238 if(debugMode){
TickTock 116:5cd72bae7c12 239 printMsg(" Getting Group 5 data\n");
TickTock 97:a25940fd7b5b 240 }
garygid 87:46ac3f2519d6 241
TickTock 121:553faf139a20 242 }else if(canRXmsg.data[3]==6){//Group 6 data = shunt data
TickTock 124:0d622967b764 243 bdi=BatDataBaseG6; // index offset for Group 6 data
TickTock 121:553faf139a20 244 if(debugMode){
TickTock 121:553faf139a20 245 printMsg(" Getting Group 6 data\n");
TickTock 121:553faf139a20 246 }
TickTock 121:553faf139a20 247
TickTock 83:52b1f330a62d 248 }else bdi=0xff; // ignore other messages (for now)
TickTock 83:52b1f330a62d 249 lasti=0;
TickTock 83:52b1f330a62d 250 }
garygid 87:46ac3f2519d6 251
TickTock 83:52b1f330a62d 252 if(bdi<0xff){
TickTock 83:52b1f330a62d 253 i=canRXmsg.data[0]&0x0f; //lower nibble of D0 is index
TickTock 83:52b1f330a62d 254 if(lasti>i){ //detect rollover and offset index appropriately
TickTock 115:549410af477d 255 bdi += 0x10; // for CP data
TickTock 83:52b1f330a62d 256 }
TickTock 83:52b1f330a62d 257 lasti=i; //remember the msb to detect rollover next time around
TickTock 83:52b1f330a62d 258 i+=bdi;
garygid 87:46ac3f2519d6 259 //-------
TickTock 121:553faf139a20 260 //-------
TickTock 121:553faf139a20 261 i*=7;
TickTock 124:0d622967b764 262 if(i+6 < BatDataBufMax) {
TickTock 124:0d622967b764 263 battData[i+0]=canRXmsg.data[1];
TickTock 124:0d622967b764 264 battData[i+1]=canRXmsg.data[2];
TickTock 124:0d622967b764 265 battData[i+2]=canRXmsg.data[3];
TickTock 124:0d622967b764 266 battData[i+3]=canRXmsg.data[4];
TickTock 124:0d622967b764 267 battData[i+4]=canRXmsg.data[5];
TickTock 124:0d622967b764 268 battData[i+5]=canRXmsg.data[6];
TickTock 124:0d622967b764 269 battData[i+6]=canRXmsg.data[7];
TickTock 121:553faf139a20 270 }
TickTock 124:0d622967b764 271 if(i==(BatDataBaseG6+3)*7){ // All data loaded
TickTock 83:52b1f330a62d 272 logCP=yesBattLog; // Only log if logging enabled
TickTock 83:52b1f330a62d 273 showCP=true; // Always show
TickTock 121:553faf139a20 274
TickTock 121:553faf139a20 275 // Find hottest temperature by finding smallest ADC value
TickTock 102:fd19f777a0b4 276 // 2013 models only have three sensors
TickTock 124:0d622967b764 277 k=battData[(BatDataBaseG4*7)+3]*0x100+battData[(BatDataBaseG4*7)+4];
TickTock 124:0d622967b764 278 j=battData[(BatDataBaseG4*7)+6]*0x100+battData[(BatDataBaseG4*7)+7];
TickTock 115:549410af477d 279 if(j<k)k=j;
TickTock 124:0d622967b764 280 j=battData[(BatDataBaseG4*7)+9]*0x100+battData[(BatDataBaseG4*7)+10];
TickTock 115:549410af477d 281 if(j<k)k=j;
TickTock 124:0d622967b764 282 j=battData[(BatDataBaseG4*7)+12]*0x100+battData[(BatDataBaseG4*7)+13];
TickTock 115:549410af477d 283 if(j<k)k=j;
TickTock 108:29b5a760adc2 284 //interpolate from lookup table
TickTock 115:549410af477d 285 unsigned short temp_adc[8] = {1000,589,487,401,365,340,309,000};
TickTock 115:549410af477d 286 float temp_C[8] = { -27, 13, 23, 32, 36, 39, 43, 76};
TickTock 108:29b5a760adc2 287 char ii=0;
TickTock 108:29b5a760adc2 288 while(k<=temp_adc[++ii]) { } // Find section in table
TickTock 108:29b5a760adc2 289 maxTemp=(float)(k-temp_adc[ii]);
TickTock 108:29b5a760adc2 290 maxTemp/=(float)(temp_adc[ii-1]-temp_adc[ii]);
TickTock 108:29b5a760adc2 291 maxTemp*=(temp_C[ii-1]-temp_C[ii]);
TickTock 108:29b5a760adc2 292 maxTemp+=temp_C[ii];
TickTock 41:8d4609ea7259 293
TickTock 121:553faf139a20 294 // Get state of health
TickTock 143:88b5155622a5 295 SOH2_x100=battData[(BatDataBaseG1*7)+29]*0x100+battData[(BatDataBaseG1*7)+30];
TickTock 124:0d622967b764 296 Ah_x10000=battData[(BatDataBaseG1*7)+36]*0x10000+battData[(BatDataBaseG1*7)+37]*0x100+battData[(BatDataBaseG1*7)+38];
TickTock 124:0d622967b764 297 SOC_x10000=battData[(BatDataBaseG1*7)+32]*0x10000+battData[(BatDataBaseG1*7)+33]*0x100+battData[(BatDataBaseG1*7)+34];
TickTock 143:88b5155622a5 298 accV2=(float)battData[(BatDataBaseG1*7)+23]/4+(float)battData[(BatDataBaseG1*7)+24]/1024;
TickTock 121:553faf139a20 299
TickTock 121:553faf139a20 300 // Save shunt data
TickTock 121:553faf139a20 301 for(j=0; j<24; j++){
TickTock 124:0d622967b764 302 shunt[j*4+0]=battData[BatDataBaseG6*7+j+3]&0x08;
TickTock 124:0d622967b764 303 shunt[j*4+1]=battData[BatDataBaseG6*7+j+3]&0x04;
TickTock 124:0d622967b764 304 shunt[j*4+2]=battData[BatDataBaseG6*7+j+3]&0x02;
TickTock 124:0d622967b764 305 shunt[j*4+3]=battData[BatDataBaseG6*7+j+3]&0x01;
TickTock 121:553faf139a20 306 }
TickTock 83:52b1f330a62d 307 }
TickTock 83:52b1f330a62d 308 }
TickTock 83:52b1f330a62d 309 }else if((mType==1)&&(canRXmsg.id==0x1db)){ //Battery Volts and Amps
TickTock 119:0e2b641e98a2 310 packV_x2=((canRXmsg.data[2]<<2)|(canRXmsg.data[3]>>6)); // 1 LSB = 0.5V
TickTock 119:0e2b641e98a2 311 packA_x2=((canRXmsg.data[0]<<3)|(canRXmsg.data[1]>>5)); // 1 LSB = 0.5A
TickTock 119:0e2b641e98a2 312 if(packA_x2>0x03ff){
TickTock 119:0e2b641e98a2 313 packA_x2|=0xf800;//extend sign;
TickTock 83:52b1f330a62d 314 }
TickTock 119:0e2b641e98a2 315 packA_x2 -= 1; //Slight correction to value required (unique to my Leaf?)
TickTock 121:553faf139a20 316 if (-packA_x2<Imin){
TickTock 121:553faf139a20 317 Imin=-packA_x2;
TickTock 121:553faf139a20 318 } else if (-packA_x2>Imax){
TickTock 121:553faf139a20 319 Imax=-packA_x2;
TickTock 121:553faf139a20 320 }
TickTock 119:0e2b641e98a2 321 imWs_x4 = packV_x2; // Volts*milliSeconds*2
TickTock 119:0e2b641e98a2 322 imWs_x4 *= -packA_x2; // milliWattseconds*4
TickTock 118:02010b18efdc 323 mWs_x4 += imWs_x4; // total mWs_x4
TickTock 121:553faf139a20 324 float temp;
TickTock 121:553faf139a20 325 temp = Resr;
TickTock 121:553faf139a20 326 temp *= (float) -packA_x2;
TickTock 121:553faf139a20 327 temp += (float) packV_x2;
TickTock 120:041edeec08f5 328 if(temp>curRmax){
TickTock 120:041edeec08f5 329 curRmax=temp;
TickTock 120:041edeec08f5 330 } else if(temp<curRmin){
TickTock 120:041edeec08f5 331 curRmin=temp;
TickTock 120:041edeec08f5 332 }
TickTock 121:553faf139a20 333 temp = Resr-0.001;
TickTock 121:553faf139a20 334 temp *= (float) -packA_x2;
TickTock 121:553faf139a20 335 temp += (float) packV_x2;
TickTock 120:041edeec08f5 336 if(temp>redRmax){
TickTock 120:041edeec08f5 337 redRmax=temp;
TickTock 120:041edeec08f5 338 } else if(temp<redRmin){
TickTock 120:041edeec08f5 339 redRmin=temp;
TickTock 120:041edeec08f5 340 }
TickTock 121:553faf139a20 341 temp = Resr+0.001;
TickTock 121:553faf139a20 342 temp *= (float) -packA_x2;
TickTock 121:553faf139a20 343 temp += (float) packV_x2;
TickTock 120:041edeec08f5 344 if(temp>incRmax){
TickTock 120:041edeec08f5 345 incRmax=temp;
TickTock 120:041edeec08f5 346 } else if(temp<incRmin){
TickTock 120:041edeec08f5 347 incRmin=temp;
TickTock 120:041edeec08f5 348 }
TickTock 118:02010b18efdc 349 numWsamples++;
TickTock 83:52b1f330a62d 350 }else if((mType==1)&&(canRXmsg.id==0x1da)){ //Motor Speed
TickTock 83:52b1f330a62d 351 imotorRPM=((canRXmsg.data[4]<<8)|(canRXmsg.data[5]));
TickTock 83:52b1f330a62d 352 if(imotorRPM<0){ // take absolute value
TickTock 83:52b1f330a62d 353 imotorRPM=-imotorRPM;
TickTock 83:52b1f330a62d 354 }
TickTock 83:52b1f330a62d 355 motorRPM+=imotorRPM;
TickTock 92:935adef49ea4 356 numSsamples++;
TickTock 148:6e3b9135fad2 357 // }else if((mType==2)&&(canRXmsg.id==0x1ca)){ //Brake Pressure
TickTock 148:6e3b9135fad2 358 }else if((mType==2)&&(canRXmsg.id==0x292)){ //Brake Pressure
TickTock 140:ab3e94eb0227 359 if(brakeMon){
TickTock 140:ab3e94eb0227 360 if(canRXmsg.data[0]<0xff){
TickTock 148:6e3b9135fad2 361 if((canRXmsg.data[6]*imotorRPM)<brkMonThr){
TickTock 140:ab3e94eb0227 362 chirpInt=0;
TickTock 140:ab3e94eb0227 363 }else{
TickTock 140:ab3e94eb0227 364 chirpInt=brkMonRate/imotorRPM;
TickTock 148:6e3b9135fad2 365 chirpInt/=canRXmsg.data[6];
TickTock 140:ab3e94eb0227 366 }
TickTock 140:ab3e94eb0227 367 }
TickTock 140:ab3e94eb0227 368 }
TickTock 13:62e0f7f39ff5 369 }
TickTock 37:fea2c1d52c5f 370 }
TickTock 13:62e0f7f39ff5 371 }
TickTock 13:62e0f7f39ff5 372
garygid 87:46ac3f2519d6 373 //-----------------------------
TickTock 13:62e0f7f39ff5 374 void logTS () {
TickTock 13:62e0f7f39ff5 375 CANMessage tsMsg;
TickTock 13:62e0f7f39ff5 376 unsigned long secs = time(NULL); // seconds past 12:00:00 AM 1 Jan 1900
garygid 69:6bfdfc002036 377 // NOTE: In Mbed, I believe that this is seconds past start of 1970, not 1900
garygid 69:6bfdfc002036 378 // but this is good, since seconds past 1970 is what CAN-Do expects. GG - Date Time
TickTock 13:62e0f7f39ff5 379 tsMsg.id=0xfff;
TickTock 13:62e0f7f39ff5 380 tsMsg.len=0xf;
garygid 69:6bfdfc002036 381 tsMsg.data[0]=secs&0xff;
TickTock 13:62e0f7f39ff5 382 tsMsg.data[1]=(secs>>8)&0xff;
TickTock 13:62e0f7f39ff5 383 tsMsg.data[2]=(secs>>16)&0xff;
garygid 69:6bfdfc002036 384 tsMsg.data[3]=(secs>>24)&0xff;
garygid 69:6bfdfc002036 385 tsMsg.data[4]=0; // 0xff; gg - Date Time
garygid 69:6bfdfc002036 386 tsMsg.data[5]=0; // 0xff; for CAN-Do
garygid 69:6bfdfc002036 387 tsMsg.data[6]=0; // 0xff;
TickTock 13:62e0f7f39ff5 388 tsMsg.data[7]=0xff;
garygid 69:6bfdfc002036 389 logCan(0,tsMsg); // Date-Time
garygid 69:6bfdfc002036 390 }
garygid 69:6bfdfc002036 391
TickTock 93:c2402e8cd0e2 392 void logEvent (char * errMsg) {
garygid 69:6bfdfc002036 393 // log CAN-Do 8-character Pseudo Message
garygid 69:6bfdfc002036 394 CANMessage tsMsg;
garygid 69:6bfdfc002036 395 tsMsg.id=0xffe; // pseudo Message to CAN-Do log
garygid 69:6bfdfc002036 396 tsMsg.len=0xf;
garygid 69:6bfdfc002036 397 int iMsgLen = strlen(errMsg);
garygid 69:6bfdfc002036 398 // 8 character message compatible with CAN-Do
garygid 69:6bfdfc002036 399 for(int i=0; i<8; i++){
garygid 69:6bfdfc002036 400 tsMsg.data[i]=' ';
garygid 69:6bfdfc002036 401 if( i < iMsgLen ) tsMsg.data[i]=errMsg[i];
garygid 69:6bfdfc002036 402 }
garygid 69:6bfdfc002036 403 logCan(0,tsMsg); // FFE Comment Message
TickTock 13:62e0f7f39ff5 404 }
TickTock 13:62e0f7f39ff5 405
TickTock 78:a383971fe02f 406 void sendReq() {
TickTock 78:a383971fe02f 407 static char data[8] = {0x02, 0x21, 0x01, 0xff, 0xff, 0xff, 0xff, 0xff};
TickTock 78:a383971fe02f 408 if(reqMsgCnt<99){
TickTock 78:a383971fe02f 409 switch (reqMsgCnt){
TickTock 124:0d622967b764 410 case BatDataBaseG1:
TickTock 138:a2f5af85ed0d 411 can2.monitor(false); // set to active mode
TickTock 138:a2f5af85ed0d 412 can2SleepMode = 0; // enable TX
TickTock 79:68f0dd8d1f19 413 data[0]=0x02; //change to request group 1
TickTock 78:a383971fe02f 414 data[1]=0x21;
TickTock 78:a383971fe02f 415 data[2]=0x01;
TickTock 78:a383971fe02f 416 break;
TickTock 124:0d622967b764 417 case BatDataBaseG2: // group 1 has 6 frames
TickTock 79:68f0dd8d1f19 418 data[0]=0x02; //change to request group 2 (cp data)
TickTock 78:a383971fe02f 419 data[1]=0x21;
TickTock 78:a383971fe02f 420 data[2]=0x02;
TickTock 78:a383971fe02f 421 break;
TickTock 124:0d622967b764 422 case BatDataBaseG3: // group 2 has 29 frames
TickTock 79:68f0dd8d1f19 423 data[0]=0x02; //change to request group 3
TickTock 78:a383971fe02f 424 data[1]=0x21;
TickTock 78:a383971fe02f 425 data[2]=0x03;
TickTock 78:a383971fe02f 426 break;
TickTock 124:0d622967b764 427 case BatDataBaseG4: // group 3 has 5 frames
TickTock 79:68f0dd8d1f19 428 data[0]=0x02; //change to request group 4 (temperature)
TickTock 78:a383971fe02f 429 data[1]=0x21;
TickTock 78:a383971fe02f 430 data[2]=0x04;
TickTock 78:a383971fe02f 431 break;
TickTock 124:0d622967b764 432 case BatDataBaseG5: // group 4 has 3 frames
TickTock 79:68f0dd8d1f19 433 data[0]=0x02; //change to request group 5
TickTock 78:a383971fe02f 434 data[1]=0x21;
TickTock 78:a383971fe02f 435 data[2]=0x05;
TickTock 78:a383971fe02f 436 break;
TickTock 124:0d622967b764 437 case BatDataBaseG6: // group 4 has 3 frames
TickTock 124:0d622967b764 438 data[0]=0x02; //change to request group 5
TickTock 121:553faf139a20 439 data[1]=0x21;
TickTock 121:553faf139a20 440 data[2]=0x06;
TickTock 121:553faf139a20 441 break;
TickTock 124:0d622967b764 442 case BatDataBaseG7: // group 5 has 11 frames
TickTock 78:a383971fe02f 443 reqMsgCnt = 99;
TickTock 138:a2f5af85ed0d 444 can2SleepMode = VP230Sleep; // disable TX
TickTock 138:a2f5af85ed0d 445 can2.monitor(true); // set to snoop mode
TickTock 79:68f0dd8d1f19 446 msgReq.detach(); // stop ticker
TickTock 78:a383971fe02f 447 default:
TickTock 78:a383971fe02f 448 data[0]=0x30; //change to request next line message
TickTock 78:a383971fe02f 449 data[1]=0x01;
TickTock 78:a383971fe02f 450 data[2]=0x00;
TickTock 78:a383971fe02f 451 }
TickTock 138:a2f5af85ed0d 452 can2.write(CANMessage(0x79b, data, 8));
TickTock 78:a383971fe02f 453 reqMsgCnt++;
TickTock 78:a383971fe02f 454 }
TickTock 78:a383971fe02f 455 }
TickTock 78:a383971fe02f 456
TickTock 138:a2f5af85ed0d 457 void sendTempReq(){
TickTock 138:a2f5af85ed0d 458 //Requests ambient and cabin temperature
TickTock 138:a2f5af85ed0d 459 char data[8] = {0x03, 0x22, 0x11, 0x5d, 0xff, 0xff, 0xff, 0xff};
TickTock 138:a2f5af85ed0d 460 can2.monitor(false); // set to active mode
TickTock 138:a2f5af85ed0d 461 can2SleepMode = 0; // enable TX
TickTock 138:a2f5af85ed0d 462 can2.write(CANMessage(0x797, data, 8));
TickTock 138:a2f5af85ed0d 463 can2SleepMode = VP230Sleep; // disable TX
TickTock 138:a2f5af85ed0d 464 }
TickTock 138:a2f5af85ed0d 465
TickTock 78:a383971fe02f 466 void autoPollISR(){
TickTock 138:a2f5af85ed0d 467 //sendTempReq();
TickTock 78:a383971fe02f 468 reqMsgCnt = 0; //reset message counter
TickTock 124:0d622967b764 469 msgReq.attach(&sendReq,0.015);
TickTock 13:62e0f7f39ff5 470 }
TickTock 13:62e0f7f39ff5 471
TickTock 36:dbd39c315258 472 void playbackISR() { //Used for autoplayback
TickTock 36:dbd39c315258 473 step=true;
TickTock 36:dbd39c315258 474 }
TickTock 36:dbd39c315258 475
TickTock 13:62e0f7f39ff5 476 void recieve1() {
TickTock 13:62e0f7f39ff5 477 CANMessage msg1;
TickTock 13:62e0f7f39ff5 478 can1.read(msg1);
garygid 69:6bfdfc002036 479
TickTock 132:08748a67280a 480 secsNoEvCanMsg=0; // reset deadman switch
garygid 69:6bfdfc002036 481 if( ZeroSecTick ) { ZeroSecTick = false; logTS(); } // gg - 0-second EV bus
TickTock 106:f016912a03db 482 if(msg1.id>0) {
TickTock 106:f016912a03db 483 logCan(1, msg1); // EVcan Message Received
TickTock 106:f016912a03db 484 led1 = !led1;
TickTock 106:f016912a03db 485 }
TickTock 13:62e0f7f39ff5 486 }
TickTock 13:62e0f7f39ff5 487
TickTock 13:62e0f7f39ff5 488 void recieve2() {
TickTock 13:62e0f7f39ff5 489 CANMessage msg2;
TickTock 13:62e0f7f39ff5 490 can2.read(msg2);
garygid 69:6bfdfc002036 491
TickTock 132:08748a67280a 492 secsNoCarCanMsg=0; // reset deadman switch
TickTock 134:ad243e4f1a17 493 if( ZeroSecTick ) { ZeroSecTick = false; logTS(); } // gg - 0-second CAR bus
TickTock 106:f016912a03db 494 if(msg2.id>0) {
TickTock 106:f016912a03db 495 logCan(2, msg2); // CARcan Message Received
TickTock 106:f016912a03db 496 led2 = !led2;
TickTock 106:f016912a03db 497 }
TickTock 13:62e0f7f39ff5 498 }
TickTock 13:62e0f7f39ff5 499
TickTock 22:a43df3905863 500 unsigned char buttonX(unsigned short X, unsigned char columns) {
TickTock 22:a43df3905863 501 unsigned char val = X*columns/320;
TickTock 22:a43df3905863 502 return val;
TickTock 22:a43df3905863 503 }
TickTock 22:a43df3905863 504
TickTock 22:a43df3905863 505 unsigned char buttonY(unsigned short Y, unsigned char rows) {
TickTock 22:a43df3905863 506 unsigned short val = Y*rows/240;
TickTock 22:a43df3905863 507 return val;
TickTock 22:a43df3905863 508 }
TickTock 23:cd03f9c3395e 509
TickTock 23:cd03f9c3395e 510 void saveConfig(){
TickTock 23:cd03f9c3395e 511 FILE *cfile;
TickTock 147:e0f1c84c62a6 512 FIL efile; // external usb file
TickTock 147:e0f1c84c62a6 513 FRESULT sfr; // external file access flags
TickTock 147:e0f1c84c62a6 514 unsigned int bytesRW;
TickTock 147:e0f1c84c62a6 515 const int bufSize = 2048;
TickTock 147:e0f1c84c62a6 516 char buffer[bufSize];
TickTock 150:ef46ce63345c 517 char sTemp[16];
TickTock 150:ef46ce63345c 518 printMsg("Saving local config file.\n");
TickTock 150:ef46ce63345c 519 wait(2);
TickTock 99:c05abf8e1cdc 520 cfile = fopen("/local/config.txt", "w");
TickTock 149:e9739523109f 521 fprintf(cfile,"format 8\r\n");
TickTock 23:cd03f9c3395e 522 fprintf(cfile,"x0_off %d\r\n",tt.x0_off);
TickTock 23:cd03f9c3395e 523 fprintf(cfile,"y0_off %d\r\n",tt.y0_off);
TickTock 23:cd03f9c3395e 524 fprintf(cfile,"x0_pp %d\r\n",tt.x0_pp);
TickTock 23:cd03f9c3395e 525 fprintf(cfile,"y0_pp %d\r\n",tt.y0_pp);
TickTock 23:cd03f9c3395e 526 fprintf(cfile,"x1_off %d\r\n",tt.x1_off);
TickTock 23:cd03f9c3395e 527 fprintf(cfile,"y1_off %d\r\n",tt.y1_off);
TickTock 23:cd03f9c3395e 528 fprintf(cfile,"x1_pp %d\r\n",tt.x1_pp);
TickTock 23:cd03f9c3395e 529 fprintf(cfile,"y1_pp %d\r\n",tt.y1_pp);
TickTock 23:cd03f9c3395e 530 fprintf(cfile,"x_mid %d\r\n",tt.x_mid);
TickTock 147:e0f1c84c62a6 531 if (dMode[0]==configScreen)
TickTock 147:e0f1c84c62a6 532 fprintf(cfile,"dMode0 %d\r\n",mainScreen);
TickTock 147:e0f1c84c62a6 533 else
TickTock 26:462ccb580472 534 fprintf(cfile,"dMode0 %d\r\n",dMode[0]);
TickTock 147:e0f1c84c62a6 535 if (dMode[1]==configScreen)
TickTock 147:e0f1c84c62a6 536 fprintf(cfile,"dMode1 %d\r\n",mainScreen);
TickTock 147:e0f1c84c62a6 537 else
TickTock 26:462ccb580472 538 fprintf(cfile,"dMode1 %d\r\n",dMode[1]);
TickTock 35:5acbd8a64a89 539 fprintf(cfile,"ledHi %4.3f\r\n",ledHi);
TickTock 35:5acbd8a64a89 540 fprintf(cfile,"ledLo %4.3f\r\n",ledLo);
TickTock 35:5acbd8a64a89 541 fprintf(cfile,"pollInt %d\r\n",pollInt);
TickTock 35:5acbd8a64a89 542 fprintf(cfile,"scale12V %4.2f\r\n",scale12V);
TickTock 48:d1ce92104a1f 543 fprintf(cfile,"skin %d\r\n",skin);
TickTock 50:83d5864c64a0 544 fprintf(cfile,"dtePeriod %d\r\n",dtePeriod);
garygid 87:46ac3f2519d6 545 fprintf(cfile,"DebugMode %d\r\n",(debugMode?1:0));
leafman 98:9f8bab96edff 546 fprintf(cfile,"metric %d\r\n",(metric?1:0));
leafman 98:9f8bab96edff 547 fprintf(cfile, "firmware %d\r\n", fwCount );
TickTock 131:0d926c080a65 548 fprintf(cfile,"showHealth %d\r\n",(showHealth?1:0));
TickTock 140:ab3e94eb0227 549 fprintf(cfile,"brakeMon %d\r\n",(brakeMon?1:0));
TickTock 141:cf13a632ddb5 550 fprintf(cfile,"brkMonRate %d\r\n", brkMonRate );
TickTock 150:ef46ce63345c 551 fprintf(cfile,"brkMonThr %d\r\n", brkMonThr );
TickTock 149:e9739523109f 552 for(char i=0;i<8;i++){
TickTock 150:ef46ce63345c 553 sprintf(sTemp,"usrMsgId %04x",uMsgId[i]);
TickTock 150:ef46ce63345c 554 fprintf(cfile,"%s\r\n", sTemp );
TickTock 149:e9739523109f 555 }
TickTock 23:cd03f9c3395e 556 fclose(cfile);
TickTock 147:e0f1c84c62a6 557
TickTock 147:e0f1c84c62a6 558 // Make copy of CONFIG.TXT
TickTock 150:ef46ce63345c 559 printMsg("Saving CONFIG.BAK.\n");
TickTock 150:ef46ce63345c 560 wait(2);
TickTock 147:e0f1c84c62a6 561 cfile = fopen("/local/CONFIG.TXT", "r");
TickTock 147:e0f1c84c62a6 562 sfr = f_open(&efile,"CONFIG.BAK",FA_WRITE|FA_CREATE_NEW);
TickTock 147:e0f1c84c62a6 563 if((cfile != NULL)&&(sfr == FR_OK)){
TickTock 147:e0f1c84c62a6 564 printMsg("Copy config file to USB\n");
TickTock 147:e0f1c84c62a6 565 while (!feof(cfile))
TickTock 147:e0f1c84c62a6 566 {
TickTock 147:e0f1c84c62a6 567 bytesRW=fread(buffer, 1, bufSize, cfile);
TickTock 147:e0f1c84c62a6 568 sfr=f_write(&efile,&buffer,bytesRW,&bytesRW);
TickTock 147:e0f1c84c62a6 569 }
TickTock 147:e0f1c84c62a6 570 fflush(cfile);
TickTock 147:e0f1c84c62a6 571 fclose(cfile);
TickTock 147:e0f1c84c62a6 572 f_close(&efile);
TickTock 147:e0f1c84c62a6 573 }
TickTock 150:ef46ce63345c 574
TickTock 150:ef46ce63345c 575 // Make copy of ehist.cny
TickTock 150:ef46ce63345c 576 printMsg("Saving ehist.bak.\n");
TickTock 150:ef46ce63345c 577 wait(2);
TickTock 150:ef46ce63345c 578 cfile = fopen("/local/ehist.cny", "r");
TickTock 150:ef46ce63345c 579 sfr = f_open(&efile,"ehist.bak",FA_WRITE|FA_CREATE_NEW);
TickTock 150:ef46ce63345c 580 if((cfile != NULL)&&(sfr == FR_OK)){
TickTock 150:ef46ce63345c 581 printMsg("Copy config file to USB\n");
TickTock 150:ef46ce63345c 582 while (!feof(cfile))
TickTock 150:ef46ce63345c 583 {
TickTock 150:ef46ce63345c 584 bytesRW=fread(buffer, 1, bufSize, cfile);
TickTock 150:ef46ce63345c 585 sfr=f_write(&efile,&buffer,bytesRW,&bytesRW);
TickTock 150:ef46ce63345c 586 }
TickTock 150:ef46ce63345c 587 fflush(cfile);
TickTock 150:ef46ce63345c 588 fclose(cfile);
TickTock 150:ef46ce63345c 589 f_close(&efile);
TickTock 150:ef46ce63345c 590 }
TickTock 147:e0f1c84c62a6 591 wait(2);
TickTock 23:cd03f9c3395e 592 }
TickTock 23:cd03f9c3395e 593
TickTock 111:d1559bb25c43 594 void readConfig(){
TickTock 23:cd03f9c3395e 595 FILE *cfile;
TickTock 23:cd03f9c3395e 596 int ff;
TickTock 150:ef46ce63345c 597 char sTemp[16];
TickTock 131:0d926c080a65 598
TickTock 23:cd03f9c3395e 599 cfile = fopen("/local/config.txt", "r");
TickTock 23:cd03f9c3395e 600 if (cfile==NULL){ // if doesn't exist --> create
TickTock 116:5cd72bae7c12 601 printMsg("No config file found.\n"); // no config file
TickTock 116:5cd72bae7c12 602 printMsg("Calibrating touch screen.\n"); // calibrating
TickTock 23:cd03f9c3395e 603 //tt.setcal(5570, 34030, 80, 108, 33700, 5780, 82, 108, 32500);// bypass calibration using my values
TickTock 23:cd03f9c3395e 604 tt.calibrate(); // run touchscreen calibration routine
garygid 58:4d06288d75a2 605 // NOTE: calibrates screen 1 first, then screen 0.
TickTock 23:cd03f9c3395e 606 saveConfig();
TickTock 23:cd03f9c3395e 607 } else {
TickTock 102:fd19f777a0b4 608 ledHi = 0.8;
TickTock 150:ef46ce63345c 609 ledLo = 0.3;
TickTock 102:fd19f777a0b4 610 pollInt = 60;
TickTock 48:d1ce92104a1f 611 scale12V = 16.2;
TickTock 48:d1ce92104a1f 612 skin = ttSkin;
leafman 98:9f8bab96edff 613 fscanf(cfile, "format %d\r\n", &ff );
leafman 98:9f8bab96edff 614 fscanf(cfile, "x0_off %d\r\n", &tt.x0_off );
leafman 98:9f8bab96edff 615 fscanf(cfile, "y0_off %d\r\n", &tt.y0_off );
leafman 98:9f8bab96edff 616 fscanf(cfile, "x0_pp %d\r\n", &tt.x0_pp );
leafman 98:9f8bab96edff 617 fscanf(cfile, "y0_pp %d\r\n", &tt.y0_pp );
leafman 98:9f8bab96edff 618 fscanf(cfile, "x1_off %d\r\n", &tt.x1_off );
leafman 98:9f8bab96edff 619 fscanf(cfile, "y1_off %d\r\n", &tt.y1_off );
leafman 98:9f8bab96edff 620 fscanf(cfile, "x1_pp %d\r\n", &tt.x1_pp );
leafman 98:9f8bab96edff 621 fscanf(cfile, "y1_pp %d\r\n", &tt.y1_pp );
leafman 98:9f8bab96edff 622 fscanf(cfile, "x_mid %d\r\n", &tt.x_mid );
leafman 98:9f8bab96edff 623 fscanf(cfile, "dMode0 %d\r\n", &dMode[0] );
leafman 98:9f8bab96edff 624 fscanf(cfile, "dMode1 %d\r\n", &dMode[1] );
TickTock 35:5acbd8a64a89 625 if(ff>1){
leafman 98:9f8bab96edff 626 fscanf(cfile, "ledHi %f\r\n", &ledHi );
leafman 98:9f8bab96edff 627 fscanf(cfile, "ledLo %f\r\n", &ledLo );
leafman 98:9f8bab96edff 628 fscanf(cfile, "pollInt %d\r\n", &pollInt );
leafman 98:9f8bab96edff 629 fscanf(cfile, "scale12V %f\r\n", &scale12V );
TickTock 48:d1ce92104a1f 630 }
TickTock 48:d1ce92104a1f 631 if(ff>2){
leafman 98:9f8bab96edff 632 fscanf(cfile, "skin %d\r\n", &skin );
leafman 98:9f8bab96edff 633 fscanf(cfile, "dtePeriod %d\r\n", &dtePeriod );
TickTock 35:5acbd8a64a89 634 }
garygid 87:46ac3f2519d6 635 if(ff>3){
leafman 98:9f8bab96edff 636 int iDebug;
leafman 98:9f8bab96edff 637 fscanf(cfile, "DebugMode %d\r\n", &iDebug );
leafman 98:9f8bab96edff 638 debugMode = (bool)iDebug;
leafman 98:9f8bab96edff 639 }
leafman 98:9f8bab96edff 640 if(ff>4) {
leafman 98:9f8bab96edff 641 int iMetric;
leafman 98:9f8bab96edff 642 fscanf(cfile, "metric %d\r\n", &iMetric );
TickTock 141:cf13a632ddb5 643 metric = (bool)iMetric; // This will get re-assigned based on dash selection
leafman 98:9f8bab96edff 644 fscanf(cfile, "firmware %d\r\n", &iMetric );
leafman 98:9f8bab96edff 645 fwCount = iMetric;
TickTock 35:5acbd8a64a89 646 }
TickTock 131:0d926c080a65 647 if(ff>5){
TickTock 131:0d926c080a65 648 int ishowHealth;
TickTock 131:0d926c080a65 649 fscanf(cfile, "showHealth %d\r\n", &ishowHealth );
TickTock 131:0d926c080a65 650 showHealth = (bool)ishowHealth;
TickTock 131:0d926c080a65 651 }
TickTock 140:ab3e94eb0227 652 if(ff>6){
TickTock 140:ab3e94eb0227 653 int iBrakeMon;
TickTock 140:ab3e94eb0227 654 fscanf(cfile, "brakeMon %d\r\n", &iBrakeMon );
TickTock 140:ab3e94eb0227 655 brakeMon = (bool)iBrakeMon;
TickTock 141:cf13a632ddb5 656 fscanf(cfile, "brkMonRate %d\r\n", &brkMonRate );
TickTock 141:cf13a632ddb5 657 fscanf(cfile, "brkMonThr %d\r\n", &brkMonThr );
TickTock 140:ab3e94eb0227 658 }
TickTock 149:e9739523109f 659 if(ff>7){
TickTock 149:e9739523109f 660 for(char i=0;i<8;i++){
TickTock 150:ef46ce63345c 661 fscanf(cfile, "usrMsgId %s\r\n", &sTemp );
TickTock 150:ef46ce63345c 662 sscanf(sTemp,"%4x", &uMsgId[i]);
TickTock 149:e9739523109f 663 }
TickTock 149:e9739523109f 664 }
TickTock 23:cd03f9c3395e 665 fclose(cfile);
TickTock 149:e9739523109f 666 if((ff>8)||(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 667 //Something wrong. Load defaults
TickTock 148:6e3b9135fad2 668 printf("Invalid config file. Loading defaults.\n");
TickTock 148:6e3b9135fad2 669 wait(3);
TickTock 148:6e3b9135fad2 670 ff=8;
TickTock 148:6e3b9135fad2 671 tt.x0_off=5732;
TickTock 148:6e3b9135fad2 672 tt.y0_off=34009;
TickTock 148:6e3b9135fad2 673 tt.x0_pp=77;
TickTock 148:6e3b9135fad2 674 tt.y0_pp=106;
TickTock 148:6e3b9135fad2 675 tt.x1_off=33955;
TickTock 148:6e3b9135fad2 676 tt.y1_off=6310;
TickTock 148:6e3b9135fad2 677 tt.x1_pp=80;
TickTock 148:6e3b9135fad2 678 tt.y1_pp=104;
TickTock 148:6e3b9135fad2 679 tt.x_mid=31986;
TickTock 148:6e3b9135fad2 680 dMode[0]=4;
TickTock 148:6e3b9135fad2 681 dMode[1]=2;
TickTock 148:6e3b9135fad2 682 ledHi=0.800;
TickTock 150:ef46ce63345c 683 ledLo=0.300;
TickTock 148:6e3b9135fad2 684 pollInt=300;
TickTock 148:6e3b9135fad2 685 scale12V=16.20;
TickTock 148:6e3b9135fad2 686 skin=0;
TickTock 148:6e3b9135fad2 687 dtePeriod=14;
TickTock 148:6e3b9135fad2 688 debugMode=false;
TickTock 148:6e3b9135fad2 689 metric=false;
TickTock 148:6e3b9135fad2 690 fwCount=1;
TickTock 148:6e3b9135fad2 691 showHealth=true;
TickTock 148:6e3b9135fad2 692 brakeMon=true;
TickTock 148:6e3b9135fad2 693 brkMonRate=400000;
TickTock 148:6e3b9135fad2 694 brkMonThr=4000;
TickTock 149:e9739523109f 695 uMsgId[0]=0x5103;
TickTock 149:e9739523109f 696 uMsgId[1]=0x50a3;
TickTock 149:e9739523109f 697 uMsgId[2]=0x54a4;
TickTock 149:e9739523109f 698 uMsgId[3]=0x54b4;
TickTock 149:e9739523109f 699 uMsgId[4]=0x54c0;
TickTock 149:e9739523109f 700 uMsgId[5]=0x55b4;
TickTock 149:e9739523109f 701 uMsgId[6]=0x0000;
TickTock 149:e9739523109f 702 uMsgId[7]=0x0000;
TickTock 148:6e3b9135fad2 703 }
TickTock 150:ef46ce63345c 704 if(ff<8){//If not latest format, save as latest format
TickTock 35:5acbd8a64a89 705 saveConfig();
TickTock 116:5cd72bae7c12 706 printMsg("Config file format updated.\n"); // config forat updates
TickTock 48:d1ce92104a1f 707 }
TickTock 116:5cd72bae7c12 708 printMsg("Config file loaded.\n"); // config file loaded
TickTock 23:cd03f9c3395e 709 }
TickTock 23:cd03f9c3395e 710 }
TickTock 25:ddf0ec209f03 711
TickTock 25:ddf0ec209f03 712 void upDate(unsigned char field, bool upDownBar){
TickTock 25:ddf0ec209f03 713 struct tm t; // pointer to a static tm structure
TickTock 25:ddf0ec209f03 714 time_t seconds ;
TickTock 25:ddf0ec209f03 715 seconds = time(NULL);
TickTock 25:ddf0ec209f03 716 t = *localtime(&seconds) ;
TickTock 25:ddf0ec209f03 717 switch(field){
TickTock 25:ddf0ec209f03 718 case 0: // year
TickTock 25:ddf0ec209f03 719 if (upDownBar) {
TickTock 25:ddf0ec209f03 720 t.tm_year = t.tm_year+1;
TickTock 25:ddf0ec209f03 721 } else {
TickTock 25:ddf0ec209f03 722 t.tm_year = t.tm_year-1;
TickTock 25:ddf0ec209f03 723 }
TickTock 25:ddf0ec209f03 724 break;
TickTock 25:ddf0ec209f03 725 case 1: // month
TickTock 25:ddf0ec209f03 726 if (upDownBar) {
TickTock 25:ddf0ec209f03 727 t.tm_mon = (t.tm_mon<12)?t.tm_mon+1:1;
TickTock 25:ddf0ec209f03 728 } else {
TickTock 25:ddf0ec209f03 729 t.tm_mon = (t.tm_mon>2)?t.tm_mon-1:12;
TickTock 25:ddf0ec209f03 730 }
TickTock 25:ddf0ec209f03 731 break;
TickTock 25:ddf0ec209f03 732 case 2: // day
TickTock 25:ddf0ec209f03 733 if (upDownBar) {
TickTock 25:ddf0ec209f03 734 t.tm_mday = (t.tm_mday<31)?t.tm_mday+1:1;
TickTock 25:ddf0ec209f03 735 } else {
TickTock 25:ddf0ec209f03 736 t.tm_mday = (t.tm_mday>2)?t.tm_mday-1:31;
TickTock 25:ddf0ec209f03 737 }
TickTock 25:ddf0ec209f03 738 break;
TickTock 25:ddf0ec209f03 739 case 3: // hour
TickTock 25:ddf0ec209f03 740 if (upDownBar) {
TickTock 25:ddf0ec209f03 741 t.tm_hour = (t.tm_hour<23)?t.tm_hour+1:0;
TickTock 25:ddf0ec209f03 742 } else {
TickTock 25:ddf0ec209f03 743 t.tm_hour = (t.tm_hour>1)?t.tm_hour-1:23;
TickTock 25:ddf0ec209f03 744 }
TickTock 25:ddf0ec209f03 745 break;
TickTock 25:ddf0ec209f03 746 case 4: // minute
TickTock 25:ddf0ec209f03 747 if (upDownBar) {
TickTock 25:ddf0ec209f03 748 t.tm_min = (t.tm_min<59)?t.tm_min+1:0;
TickTock 25:ddf0ec209f03 749 } else {
TickTock 25:ddf0ec209f03 750 t.tm_min = (t.tm_min>1)?t.tm_min-1:59;
TickTock 25:ddf0ec209f03 751 }
TickTock 25:ddf0ec209f03 752 break;
TickTock 25:ddf0ec209f03 753 case 5: // second
TickTock 25:ddf0ec209f03 754 if (upDownBar) {
TickTock 25:ddf0ec209f03 755 t.tm_sec = (t.tm_sec<59)?t.tm_sec+1:0;
TickTock 25:ddf0ec209f03 756 } else {
TickTock 25:ddf0ec209f03 757 t.tm_sec = (t.tm_sec>1)?t.tm_sec-1:59;
TickTock 25:ddf0ec209f03 758 }
TickTock 25:ddf0ec209f03 759 break;
TickTock 25:ddf0ec209f03 760 default:
TickTock 25:ddf0ec209f03 761 break;
TickTock 25:ddf0ec209f03 762 }
TickTock 25:ddf0ec209f03 763 set_time(mktime(&t));
TickTock 25:ddf0ec209f03 764 }
TickTock 25:ddf0ec209f03 765
TickTock 39:eef8beac7411 766 void logPackVoltages() { // Turbo3 - routine to dump CP values to text file
TickTock 39:eef8beac7411 767 char sTemp[40];
TickTock 39:eef8beac7411 768 struct tm t; // pointer to a static tm structure
TickTock 39:eef8beac7411 769 short unsigned max, min, jv, i, bd;
TickTock 39:eef8beac7411 770 unsigned avg;
TickTock 119:0e2b641e98a2 771 unsigned short gids, SOC, packV_x2;
TickTock 140:ab3e94eb0227 772 unsigned long odo;
TickTock 119:0e2b641e98a2 773 signed short packA_x2;
TickTock 39:eef8beac7411 774 time_t seconds ;
TickTock 39:eef8beac7411 775
TickTock 39:eef8beac7411 776 CANMessage msg;
TickTock 39:eef8beac7411 777
TickTock 39:eef8beac7411 778 seconds = time(NULL); // Turbo3
TickTock 39:eef8beac7411 779 t = *localtime(&seconds) ; // Turbo3
TickTock 39:eef8beac7411 780
TickTock 39:eef8beac7411 781 msg = lastMsg[indexLastMsg[0x5bc]]; //Get gids
TickTock 39:eef8beac7411 782 gids = (msg.data[0]<<2)+(msg.data[1]>>6);
TickTock 140:ab3e94eb0227 783 msg = lastMsg[indexLastMsg[0x5c5]]; //Get odometer
TickTock 140:ab3e94eb0227 784 odo = (msg.data[1]<16)+(msg.data[2]<<8)+msg.data[3];
TickTock 39:eef8beac7411 785 msg = lastMsg[indexLastMsg[0x55b]]; //Get SOC
TickTock 39:eef8beac7411 786 SOC = (msg.data[0]<<2)+(msg.data[1]>>6);
TickTock 39:eef8beac7411 787 msg = lastMsg[indexLastMsg[0x1db]]; //Get pack volts
TickTock 119:0e2b641e98a2 788 packV_x2 = (msg.data[2]<<2)+(msg.data[3]>>6);
TickTock 119:0e2b641e98a2 789 packA_x2 = (msg.data[0]<<3)+(msg.data[1]>>5);
TickTock 119:0e2b641e98a2 790 if (packA_x2 & 0x400) packA_x2 |= 0xf800;
TickTock 39:eef8beac7411 791
TickTock 39:eef8beac7411 792 max=0;
TickTock 39:eef8beac7411 793 min=9999;
TickTock 39:eef8beac7411 794 avg=0;
TickTock 92:935adef49ea4 795 for(i=0; i<96; i++) {
TickTock 124:0d622967b764 796 bd=(battData[BatDataBaseG2*7+i*2+3]<<8)+battData[BatDataBaseG2*7+i*2+4];
TickTock 39:eef8beac7411 797 avg+=bd;
TickTock 39:eef8beac7411 798 if(bd>max) max=bd;
TickTock 39:eef8beac7411 799 if(bd<min) min=bd;
TickTock 39:eef8beac7411 800 }
TickTock 39:eef8beac7411 801 avg /= 96;
TickTock 39:eef8beac7411 802 if(min<3713) {
TickTock 39:eef8beac7411 803 jv=avg-(max-avg)*1.5;
TickTock 39:eef8beac7411 804 } else { // Only compute judgement value if min cellpair meets <= 3712mV requirement
TickTock 39:eef8beac7411 805 jv=0;
TickTock 39:eef8beac7411 806 }
TickTock 39:eef8beac7411 807
TickTock 110:ffddff3ad2f2 808 FIL bfile;
TickTock 110:ffddff3ad2f2 809 FRESULT bfr;
TickTock 110:ffddff3ad2f2 810 bfr = f_open(&bfile,"batvolt.txt",FA_WRITE|FA_OPEN_ALWAYS);
TickTock 110:ffddff3ad2f2 811 if(bfr==FR_OK) {
TickTock 110:ffddff3ad2f2 812 f_lseek(&bfile,0xffffffff); // go to end of file to append
TickTock 39:eef8beac7411 813 strftime(sTemp, 40, "%a %m/%d/%Y %X", &t);
TickTock 110:ffddff3ad2f2 814 f_printf(&bfile,"%s,",sTemp);
TickTock 140:ab3e94eb0227 815 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 816 f_printf(&bfile,"%s,",sTemp);
TickTock 124:0d622967b764 817 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 818 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 819 for(i=0; i<96; i++) {
TickTock 124:0d622967b764 820 bd=(battData[BatDataBaseG2*7+i*2+3]<<8)+battData[BatDataBaseG2*7+i*2+4];
TickTock 110:ffddff3ad2f2 821 f_printf(&bfile,",%d",bd);
TickTock 108:29b5a760adc2 822 }
TickTock 110:ffddff3ad2f2 823 f_printf(&bfile,"\r\n");
TickTock 110:ffddff3ad2f2 824 f_close(&bfile);
TickTock 110:ffddff3ad2f2 825 }
TickTock 108:29b5a760adc2 826 logCP=false;
TickTock 108:29b5a760adc2 827 showCP=true;
TickTock 108:29b5a760adc2 828 }
TickTock 108:29b5a760adc2 829
TickTock 108:29b5a760adc2 830 void tripLog() { // Daily log
TickTock 110:ffddff3ad2f2 831 char sTemp[40];
TickTock 108:29b5a760adc2 832 struct tm t; // pointer to a static tm structure
TickTock 108:29b5a760adc2 833 short unsigned max, min, jv, i, bd;
TickTock 108:29b5a760adc2 834 unsigned avg;
TickTock 119:0e2b641e98a2 835 unsigned short gids, SOC, packV_x2;
TickTock 140:ab3e94eb0227 836 unsigned long odo;
TickTock 119:0e2b641e98a2 837 signed short packA_x2;
TickTock 39:eef8beac7411 838 time_t seconds ;
TickTock 39:eef8beac7411 839
TickTock 39:eef8beac7411 840 CANMessage msg;
TickTock 39:eef8beac7411 841
TickTock 39:eef8beac7411 842 seconds = time(NULL); // Turbo3
TickTock 39:eef8beac7411 843 t = *localtime(&seconds) ; // Turbo3
TickTock 39:eef8beac7411 844
TickTock 39:eef8beac7411 845 msg = lastMsg[indexLastMsg[0x5bc]]; //Get gids
TickTock 39:eef8beac7411 846 gids = (msg.data[0]<<2)+(msg.data[1]>>6);
TickTock 140:ab3e94eb0227 847 msg = lastMsg[indexLastMsg[0x5c5]]; //Get odometer
TickTock 140:ab3e94eb0227 848 odo = (msg.data[1]<16)+(msg.data[2]<<8)+msg.data[3];
TickTock 39:eef8beac7411 849 msg = lastMsg[indexLastMsg[0x55b]]; //Get SOC
TickTock 39:eef8beac7411 850 SOC = (msg.data[0]<<2)+(msg.data[1]>>6);
TickTock 39:eef8beac7411 851 msg = lastMsg[indexLastMsg[0x1db]]; //Get pack volts
TickTock 119:0e2b641e98a2 852 packV_x2 = (msg.data[2]<<2)+(msg.data[3]>>6);
TickTock 119:0e2b641e98a2 853 packA_x2 = (msg.data[0]<<3)+(msg.data[1]>>5);
TickTock 119:0e2b641e98a2 854 if (packA_x2 & 0x400) packA_x2 |= 0xf800;
TickTock 39:eef8beac7411 855
TickTock 39:eef8beac7411 856 max=0;
TickTock 39:eef8beac7411 857 min=9999;
TickTock 39:eef8beac7411 858 avg=0;
TickTock 39:eef8beac7411 859 for(i=0; i<96; i++) {
TickTock 124:0d622967b764 860 bd=(battData[BatDataBaseG2*7+i*2+3]<<8)+battData[BatDataBaseG2*7+i*2+4];
TickTock 39:eef8beac7411 861 avg+=bd;
TickTock 39:eef8beac7411 862 if(bd>max) max=bd;
TickTock 39:eef8beac7411 863 if(bd<min) min=bd;
TickTock 39:eef8beac7411 864 }
TickTock 39:eef8beac7411 865 avg /= 96;
TickTock 39:eef8beac7411 866 if(min<3713) {
TickTock 39:eef8beac7411 867 jv=avg-(max-avg)*1.5;
TickTock 39:eef8beac7411 868 } else { // Only compute judgement value if min cellpair meets <= 3712mV requirement
TickTock 39:eef8beac7411 869 jv=0;
TickTock 39:eef8beac7411 870 }
TickTock 39:eef8beac7411 871
TickTock 110:ffddff3ad2f2 872 FIL bfile;
TickTock 110:ffddff3ad2f2 873 FRESULT bfr;
TickTock 111:d1559bb25c43 874 bfr = f_open(&bfile,"triplog.txt",FA_WRITE|FA_OPEN_ALWAYS);
TickTock 110:ffddff3ad2f2 875 if(bfr==FR_OK) {
TickTock 110:ffddff3ad2f2 876 f_lseek(&bfile,0xffffffff); // go to end of file to append
TickTock 39:eef8beac7411 877 strftime(sTemp, 40, "%a %m/%d/%Y %X", &t);
TickTock 110:ffddff3ad2f2 878 f_printf(&bfile,"%s,",sTemp);
TickTock 148:6e3b9135fad2 879 sprintf(sTemp,"%d,%3.1f,%d,%5.1f%%,%5.1f%%,%4.2f,%5.1f,%4.1f,%4.1f,%d,%d,%d,%d,%d,%4.1f,%4.1f",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]);
TickTock 110:ffddff3ad2f2 880 f_printf(&bfile,"%s,",sTemp);
TickTock 124:0d622967b764 881 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 882 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 883 for(i=0; i<96; i++) {
TickTock 124:0d622967b764 884 bd=(battData[BatDataBaseG2*7+i*2+3]<<8)+battData[BatDataBaseG2*7+i*2+4];
TickTock 110:ffddff3ad2f2 885 f_printf(&bfile,",%d",bd);
TickTock 142:c1a11d6f181c 886 }
TickTock 110:ffddff3ad2f2 887 f_printf(&bfile,"\r\n");
TickTock 110:ffddff3ad2f2 888 f_close(&bfile);
TickTock 39:eef8beac7411 889 }
TickTock 39:eef8beac7411 890 }
TickTock 25:ddf0ec209f03 891
leafman 98:9f8bab96edff 892 //LM - updates firmware off a usb key, eliminating the need to plug
leafman 98:9f8bab96edff 893 //the CANary into a computer for updates.
leafman 98:9f8bab96edff 894 void updateFirmware()
leafman 98:9f8bab96edff 895 {
TickTock 143:88b5155622a5 896 FIL efile; // external usb file
TickTock 111:d1559bb25c43 897 FRESULT sfr; // external file access flags
TickTock 111:d1559bb25c43 898 unsigned int bytesRW;
TickTock 111:d1559bb25c43 899 char sTemp[40];
TickTock 131:0d926c080a65 900 const int bufSize = 2048;
TickTock 131:0d926c080a65 901 char buffer[bufSize];
TickTock 143:88b5155622a5 902 FILE *lfile;
TickTock 131:0d926c080a65 903
TickTock 131:0d926c080a65 904 // Check for config file on USB drive
TickTock 143:88b5155622a5 905 sfr = f_open(&efile,"CONFIG.TXT",FA_READ|FA_OPEN_EXISTING);
TickTock 131:0d926c080a65 906 if(sfr == FR_OK)
TickTock 131:0d926c080a65 907 {
TickTock 131:0d926c080a65 908 printf("Copy config file from USB\n");
TickTock 143:88b5155622a5 909 lfile = fopen("/local/CONFIG.TXT", "w");
TickTock 147:e0f1c84c62a6 910 if(lfile != NULL) {
TickTock 147:e0f1c84c62a6 911 while (!f_eof(&efile))
TickTock 147:e0f1c84c62a6 912 {
TickTock 147:e0f1c84c62a6 913 sfr=f_read(&efile,&buffer,bufSize,&bytesRW);
TickTock 147:e0f1c84c62a6 914 fwrite(buffer, 1, bytesRW, lfile);
TickTock 147:e0f1c84c62a6 915 }
TickTock 147:e0f1c84c62a6 916 fflush(lfile);
TickTock 147:e0f1c84c62a6 917 fclose(lfile);
TickTock 131:0d926c080a65 918 }
TickTock 143:88b5155622a5 919 f_close(&efile);
TickTock 150:ef46ce63345c 920 int fwc_tmp = fwCount;
TickTock 148:6e3b9135fad2 921 readConfig();
TickTock 150:ef46ce63345c 922 fwCount = fwc_tmp; // Do no overwrite fwcount when loading new config
TickTock 147:e0f1c84c62a6 923 wait(2);
TickTock 143:88b5155622a5 924 }
TickTock 147:e0f1c84c62a6 925
TickTock 150:ef46ce63345c 926 // Check for history file on USB drive
TickTock 150:ef46ce63345c 927 sfr = f_open(&efile,"ehist.cny",FA_READ|FA_OPEN_EXISTING);
TickTock 150:ef46ce63345c 928 if(sfr == FR_OK)
TickTock 150:ef46ce63345c 929 {
TickTock 150:ef46ce63345c 930 printf("Copy ehist file from USB\n");
TickTock 150:ef46ce63345c 931 lfile = fopen("/local/ehist.cny", "w");
TickTock 150:ef46ce63345c 932 if(lfile != NULL) {
TickTock 150:ef46ce63345c 933 while (!f_eof(&efile))
TickTock 150:ef46ce63345c 934 {
TickTock 150:ef46ce63345c 935 sfr=f_read(&efile,&buffer,bufSize,&bytesRW);
TickTock 150:ef46ce63345c 936 fwrite(buffer, 1, bytesRW, lfile);
TickTock 150:ef46ce63345c 937 }
TickTock 150:ef46ce63345c 938 fflush(lfile);
TickTock 150:ef46ce63345c 939 fclose(lfile);
TickTock 150:ef46ce63345c 940 }
TickTock 150:ef46ce63345c 941 f_close(&efile);
TickTock 150:ef46ce63345c 942 wait(2);
TickTock 150:ef46ce63345c 943 }
TickTock 150:ef46ce63345c 944
TickTock 150:ef46ce63345c 945
TickTock 143:88b5155622a5 946 sfr = f_open(&efile,"firmware.bin",FA_READ|FA_OPEN_EXISTING);
TickTock 111:d1559bb25c43 947 if(sfr != FR_OK)
TickTock 99:c05abf8e1cdc 948 {
TickTock 137:70853cf5a30f 949 printf("Couldn't find firmware.bin\n");
TickTock 108:29b5a760adc2 950 wait(3);
TickTock 100:63a7456fc972 951 lastDMode[whichTouched]=99;//force refresh
TickTock 99:c05abf8e1cdc 952 return;
TickTock 99:c05abf8e1cdc 953 }
leafman 98:9f8bab96edff 954 fwCount ++;
TickTock 148:6e3b9135fad2 955 saveConfig();
leafman 98:9f8bab96edff 956 //delete all bin files in /local
leafman 98:9f8bab96edff 957 DIR *dir;
leafman 98:9f8bab96edff 958 struct dirent *ent;
leafman 98:9f8bab96edff 959 printf("Starting update\n");
leafman 98:9f8bab96edff 960 printf("deleting old firmware files\n");
leafman 98:9f8bab96edff 961 if ((dir = opendir ("/local/")) != NULL) {
TickTock 109:3e6f0e8fca0d 962 // print all the files and directories within directory
leafman 98:9f8bab96edff 963 while ((ent = readdir (dir)) != NULL) {
leafman 98:9f8bab96edff 964 //printf("FILE: %s\n",ent->d_name);
leafman 98:9f8bab96edff 965 char dest[4] = "";
leafman 98:9f8bab96edff 966 strncat(dest, &ent->d_name[strlen(ent->d_name)-3],3);
leafman 98:9f8bab96edff 967 dest[0] = tolower(dest[0]);
leafman 98:9f8bab96edff 968 dest[1] = tolower(dest[1]);
leafman 98:9f8bab96edff 969 dest[2] = tolower(dest[2]);
leafman 98:9f8bab96edff 970 if(strcmp(dest,"bin")==0)
leafman 98:9f8bab96edff 971 {
leafman 98:9f8bab96edff 972 sprintf(sTemp,"/local/%s",ent->d_name);
leafman 98:9f8bab96edff 973 int result = remove(sTemp);
leafman 98:9f8bab96edff 974 printf("REMOVED: %s",ent->d_name);
leafman 98:9f8bab96edff 975 }
leafman 98:9f8bab96edff 976 }
leafman 98:9f8bab96edff 977 closedir (dir);
leafman 98:9f8bab96edff 978 } else {
TickTock 109:3e6f0e8fca0d 979 //could not open directory
leafman 98:9f8bab96edff 980 printf("Couldnt open folder");
TickTock 108:29b5a760adc2 981 wait(3);
leafman 98:9f8bab96edff 982 return;
leafman 98:9f8bab96edff 983 }
leafman 98:9f8bab96edff 984 printf("copying new firmware\n");
leafman 98:9f8bab96edff 985 tt.cls();
leafman 98:9f8bab96edff 986 //Copy the new firmware from usb->local
TickTock 131:0d926c080a65 987 //The newest bin file is the one that is used by the mbed
leafman 98:9f8bab96edff 988 sprintf(sTemp,"/local/fw%d.bin",fwCount);
leafman 98:9f8bab96edff 989 printf("Writing %s\n",sTemp);
leafman 98:9f8bab96edff 990 wait(2);
TickTock 143:88b5155622a5 991 lfile = fopen(sTemp, "wb");
TickTock 143:88b5155622a5 992 if(lfile == NULL)
leafman 98:9f8bab96edff 993 {
TickTock 131:0d926c080a65 994 printf("Couldn't Open Destination\n");
TickTock 108:29b5a760adc2 995 wait(3);
leafman 98:9f8bab96edff 996 return;
leafman 98:9f8bab96edff 997 }
TickTock 97:a25940fd7b5b 998
TickTock 143:88b5155622a5 999 while (!f_eof(&efile))
leafman 98:9f8bab96edff 1000 {
TickTock 143:88b5155622a5 1001 sfr=f_read(&efile,&buffer,bufSize,&bytesRW);
TickTock 143:88b5155622a5 1002 fwrite(buffer, 1, bytesRW, lfile);
leafman 98:9f8bab96edff 1003 }
leafman 98:9f8bab96edff 1004
TickTock 143:88b5155622a5 1005 fflush(lfile);
TickTock 143:88b5155622a5 1006 fclose(lfile);
TickTock 143:88b5155622a5 1007 f_close(&efile);
leafman 98:9f8bab96edff 1008 tt.cls();
leafman 98:9f8bab96edff 1009 printf("Succesful\n\n");
TickTock 108:29b5a760adc2 1010 printf("Rebooting in 3 seconds\n");
TickTock 108:29b5a760adc2 1011 wait(3);
leafman 98:9f8bab96edff 1012 //Now run new firmware
TickTock 111:d1559bb25c43 1013 mbed_reset();
TickTock 99:c05abf8e1cdc 1014 }
TickTock 108:29b5a760adc2 1015
TickTock 108:29b5a760adc2 1016 bool detectUSB(void){
TickTock 130:1a9d2a6d99ce 1017 FIL tfile; // external usb file
TickTock 111:d1559bb25c43 1018 bool usbEn = (f_open(&tfile,"usb.det",FA_WRITE|FA_OPEN_ALWAYS)==FR_OK);
TickTock 108:29b5a760adc2 1019 if(usbEn){
TickTock 111:d1559bb25c43 1020 f_close(&tfile);
TickTock 111:d1559bb25c43 1021 f_unlink("usb.det");
TickTock 111:d1559bb25c43 1022 }
TickTock 130:1a9d2a6d99ce 1023 return(usbEn);
TickTock 108:29b5a760adc2 1024 }
TickTock 131:0d926c080a65 1025
TickTock 140:ab3e94eb0227 1026 void chirp(void){
TickTock 140:ab3e94eb0227 1027 static unsigned short counter=0;
TickTock 140:ab3e94eb0227 1028
TickTock 140:ab3e94eb0227 1029 if(chirpInt>0){
TickTock 141:cf13a632ddb5 1030 if(++counter>chirpInt){
TickTock 141:cf13a632ddb5 1031 spkr.beep(500,0.015);
TickTock 140:ab3e94eb0227 1032 counter=0;
TickTock 140:ab3e94eb0227 1033 }
TickTock 148:6e3b9135fad2 1034 }else{
TickTock 148:6e3b9135fad2 1035 counter=0;
TickTock 140:ab3e94eb0227 1036 }
TickTock 140:ab3e94eb0227 1037 }
TickTock 140:ab3e94eb0227 1038
TickTock 131:0d926c080a65 1039 //Sample CONFIG.TXT
TickTock 131:0d926c080a65 1040 /*
TickTock 144:b0c9d30dd346 1041 format 7
TickTock 131:0d926c080a65 1042 x0_off 5732
TickTock 131:0d926c080a65 1043 y0_off 34009
TickTock 131:0d926c080a65 1044 x0_pp 77
TickTock 131:0d926c080a65 1045 y0_pp 106
TickTock 131:0d926c080a65 1046 x1_off 33955
TickTock 131:0d926c080a65 1047 y1_off 6310
TickTock 131:0d926c080a65 1048 x1_pp 80
TickTock 131:0d926c080a65 1049 y1_pp 104
TickTock 131:0d926c080a65 1050 x_mid 31986
TickTock 131:0d926c080a65 1051 dMode0 4
TickTock 131:0d926c080a65 1052 dMode1 2
TickTock 131:0d926c080a65 1053 ledHi 0.800
TickTock 150:ef46ce63345c 1054 ledLo 0.300
TickTock 131:0d926c080a65 1055 pollInt 300
TickTock 131:0d926c080a65 1056 scale12V 16.20
TickTock 131:0d926c080a65 1057 skin 0
TickTock 131:0d926c080a65 1058 dtePeriod 14
TickTock 131:0d926c080a65 1059 DebugMode 0
TickTock 144:b0c9d30dd346 1060 metric 0
TickTock 148:6e3b9135fad2 1061 firmware 1
TickTock 131:0d926c080a65 1062 showHealth 1
TickTock 141:cf13a632ddb5 1063 brakeMon 1
TickTock 141:cf13a632ddb5 1064 brkMonRate 400000
TickTock 144:b0c9d30dd346 1065 brkMonThr 4000
TickTock 150:ef46ce63345c 1066 usrMsgId 5103
TickTock 150:ef46ce63345c 1067 usrMsgId 50a3
TickTock 150:ef46ce63345c 1068 usrMsgId 54a4
TickTock 150:ef46ce63345c 1069 usrMsgId 54b4
TickTock 150:ef46ce63345c 1070 usrMsgId 54c0
TickTock 150:ef46ce63345c 1071 usrMsgId 55b4
TickTock 150:ef46ce63345c 1072 usrMsgId 0000
TickTock 150:ef46ce63345c 1073 usrMsgId 0000
TickTock 150:ef46ce63345c 1074 */