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

Committer:
TickTock
Date:
Wed Sep 25 03:33:18 2013 +0000
Revision:
149:e9739523109f
Parent:
148:6e3b9135fad2
Child:
150:ef46ce63345c
Compensated DTE with air drag of current ambient temperature.

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 147:e0f1c84c62a6 511 printMsg("Saving local config file.\n"); // no config file
TickTock 23:cd03f9c3395e 512 FILE *cfile;
TickTock 147:e0f1c84c62a6 513 FIL efile; // external usb file
TickTock 147:e0f1c84c62a6 514 FRESULT sfr; // external file access flags
TickTock 147:e0f1c84c62a6 515 unsigned int bytesRW;
TickTock 147:e0f1c84c62a6 516 const int bufSize = 2048;
TickTock 147:e0f1c84c62a6 517 char buffer[bufSize];
TickTock 147:e0f1c84c62a6 518
TickTock 99:c05abf8e1cdc 519 cfile = fopen("/local/config.txt", "w");
TickTock 149:e9739523109f 520 fprintf(cfile,"format 8\r\n");
TickTock 23:cd03f9c3395e 521 fprintf(cfile,"x0_off %d\r\n",tt.x0_off);
TickTock 23:cd03f9c3395e 522 fprintf(cfile,"y0_off %d\r\n",tt.y0_off);
TickTock 23:cd03f9c3395e 523 fprintf(cfile,"x0_pp %d\r\n",tt.x0_pp);
TickTock 23:cd03f9c3395e 524 fprintf(cfile,"y0_pp %d\r\n",tt.y0_pp);
TickTock 23:cd03f9c3395e 525 fprintf(cfile,"x1_off %d\r\n",tt.x1_off);
TickTock 23:cd03f9c3395e 526 fprintf(cfile,"y1_off %d\r\n",tt.y1_off);
TickTock 23:cd03f9c3395e 527 fprintf(cfile,"x1_pp %d\r\n",tt.x1_pp);
TickTock 23:cd03f9c3395e 528 fprintf(cfile,"y1_pp %d\r\n",tt.y1_pp);
TickTock 23:cd03f9c3395e 529 fprintf(cfile,"x_mid %d\r\n",tt.x_mid);
TickTock 147:e0f1c84c62a6 530 if (dMode[0]==configScreen)
TickTock 147:e0f1c84c62a6 531 fprintf(cfile,"dMode0 %d\r\n",mainScreen);
TickTock 147:e0f1c84c62a6 532 else
TickTock 26:462ccb580472 533 fprintf(cfile,"dMode0 %d\r\n",dMode[0]);
TickTock 147:e0f1c84c62a6 534 if (dMode[1]==configScreen)
TickTock 147:e0f1c84c62a6 535 fprintf(cfile,"dMode1 %d\r\n",mainScreen);
TickTock 147:e0f1c84c62a6 536 else
TickTock 26:462ccb580472 537 fprintf(cfile,"dMode1 %d\r\n",dMode[1]);
TickTock 35:5acbd8a64a89 538 fprintf(cfile,"ledHi %4.3f\r\n",ledHi);
TickTock 35:5acbd8a64a89 539 fprintf(cfile,"ledLo %4.3f\r\n",ledLo);
TickTock 35:5acbd8a64a89 540 fprintf(cfile,"pollInt %d\r\n",pollInt);
TickTock 35:5acbd8a64a89 541 fprintf(cfile,"scale12V %4.2f\r\n",scale12V);
TickTock 48:d1ce92104a1f 542 fprintf(cfile,"skin %d\r\n",skin);
TickTock 50:83d5864c64a0 543 fprintf(cfile,"dtePeriod %d\r\n",dtePeriod);
garygid 87:46ac3f2519d6 544 fprintf(cfile,"DebugMode %d\r\n",(debugMode?1:0));
leafman 98:9f8bab96edff 545 fprintf(cfile,"metric %d\r\n",(metric?1:0));
leafman 98:9f8bab96edff 546 fprintf(cfile, "firmware %d\r\n", fwCount );
TickTock 131:0d926c080a65 547 fprintf(cfile,"showHealth %d\r\n",(showHealth?1:0));
TickTock 140:ab3e94eb0227 548 fprintf(cfile,"brakeMon %d\r\n",(brakeMon?1:0));
TickTock 141:cf13a632ddb5 549 fprintf(cfile,"brkMonRate %d\r\n", brkMonRate );
TickTock 149:e9739523109f 550 fprintf(cfile,"brkMonThr %d\r\n", brkMonThr );
TickTock 149:e9739523109f 551 for(char i=0;i<8;i++){
TickTock 149:e9739523109f 552 fprintf(cfile,"usrMsgId %4x\r\n", i, uMsgId[i] );
TickTock 149:e9739523109f 553 }
TickTock 23:cd03f9c3395e 554 fclose(cfile);
TickTock 147:e0f1c84c62a6 555
TickTock 147:e0f1c84c62a6 556 // Make copy of CONFIG.TXT
TickTock 147:e0f1c84c62a6 557 cfile = fopen("/local/CONFIG.TXT", "r");
TickTock 147:e0f1c84c62a6 558 sfr = f_open(&efile,"CONFIG.BAK",FA_WRITE|FA_CREATE_NEW);
TickTock 147:e0f1c84c62a6 559 if((cfile != NULL)&&(sfr == FR_OK)){
TickTock 147:e0f1c84c62a6 560 printMsg("Copy config file to USB\n");
TickTock 147:e0f1c84c62a6 561 while (!feof(cfile))
TickTock 147:e0f1c84c62a6 562 {
TickTock 147:e0f1c84c62a6 563 bytesRW=fread(buffer, 1, bufSize, cfile);
TickTock 147:e0f1c84c62a6 564 sfr=f_write(&efile,&buffer,bytesRW,&bytesRW);
TickTock 147:e0f1c84c62a6 565 }
TickTock 147:e0f1c84c62a6 566 fflush(cfile);
TickTock 147:e0f1c84c62a6 567 fclose(cfile);
TickTock 147:e0f1c84c62a6 568 f_close(&efile);
TickTock 147:e0f1c84c62a6 569 }
TickTock 147:e0f1c84c62a6 570 wait(2);
TickTock 23:cd03f9c3395e 571 }
TickTock 23:cd03f9c3395e 572
TickTock 111:d1559bb25c43 573 void readConfig(){
TickTock 23:cd03f9c3395e 574 FILE *cfile;
TickTock 23:cd03f9c3395e 575 int ff;
TickTock 131:0d926c080a65 576
TickTock 23:cd03f9c3395e 577 cfile = fopen("/local/config.txt", "r");
TickTock 23:cd03f9c3395e 578 if (cfile==NULL){ // if doesn't exist --> create
TickTock 116:5cd72bae7c12 579 printMsg("No config file found.\n"); // no config file
TickTock 116:5cd72bae7c12 580 printMsg("Calibrating touch screen.\n"); // calibrating
TickTock 23:cd03f9c3395e 581 //tt.setcal(5570, 34030, 80, 108, 33700, 5780, 82, 108, 32500);// bypass calibration using my values
TickTock 23:cd03f9c3395e 582 tt.calibrate(); // run touchscreen calibration routine
garygid 58:4d06288d75a2 583 // NOTE: calibrates screen 1 first, then screen 0.
TickTock 23:cd03f9c3395e 584 saveConfig();
TickTock 23:cd03f9c3395e 585 } else {
TickTock 102:fd19f777a0b4 586 ledHi = 0.8;
TickTock 48:d1ce92104a1f 587 ledLo = 0.1;
TickTock 102:fd19f777a0b4 588 pollInt = 60;
TickTock 48:d1ce92104a1f 589 scale12V = 16.2;
TickTock 48:d1ce92104a1f 590 skin = ttSkin;
leafman 98:9f8bab96edff 591 fscanf(cfile, "format %d\r\n", &ff );
leafman 98:9f8bab96edff 592 fscanf(cfile, "x0_off %d\r\n", &tt.x0_off );
leafman 98:9f8bab96edff 593 fscanf(cfile, "y0_off %d\r\n", &tt.y0_off );
leafman 98:9f8bab96edff 594 fscanf(cfile, "x0_pp %d\r\n", &tt.x0_pp );
leafman 98:9f8bab96edff 595 fscanf(cfile, "y0_pp %d\r\n", &tt.y0_pp );
leafman 98:9f8bab96edff 596 fscanf(cfile, "x1_off %d\r\n", &tt.x1_off );
leafman 98:9f8bab96edff 597 fscanf(cfile, "y1_off %d\r\n", &tt.y1_off );
leafman 98:9f8bab96edff 598 fscanf(cfile, "x1_pp %d\r\n", &tt.x1_pp );
leafman 98:9f8bab96edff 599 fscanf(cfile, "y1_pp %d\r\n", &tt.y1_pp );
leafman 98:9f8bab96edff 600 fscanf(cfile, "x_mid %d\r\n", &tt.x_mid );
leafman 98:9f8bab96edff 601 fscanf(cfile, "dMode0 %d\r\n", &dMode[0] );
leafman 98:9f8bab96edff 602 fscanf(cfile, "dMode1 %d\r\n", &dMode[1] );
TickTock 35:5acbd8a64a89 603 if(ff>1){
leafman 98:9f8bab96edff 604 fscanf(cfile, "ledHi %f\r\n", &ledHi );
leafman 98:9f8bab96edff 605 fscanf(cfile, "ledLo %f\r\n", &ledLo );
leafman 98:9f8bab96edff 606 fscanf(cfile, "pollInt %d\r\n", &pollInt );
leafman 98:9f8bab96edff 607 fscanf(cfile, "scale12V %f\r\n", &scale12V );
TickTock 48:d1ce92104a1f 608 }
TickTock 48:d1ce92104a1f 609 if(ff>2){
leafman 98:9f8bab96edff 610 fscanf(cfile, "skin %d\r\n", &skin );
leafman 98:9f8bab96edff 611 fscanf(cfile, "dtePeriod %d\r\n", &dtePeriod );
TickTock 35:5acbd8a64a89 612 }
garygid 87:46ac3f2519d6 613 if(ff>3){
leafman 98:9f8bab96edff 614 int iDebug;
leafman 98:9f8bab96edff 615 fscanf(cfile, "DebugMode %d\r\n", &iDebug );
leafman 98:9f8bab96edff 616 debugMode = (bool)iDebug;
leafman 98:9f8bab96edff 617 }
leafman 98:9f8bab96edff 618 if(ff>4) {
leafman 98:9f8bab96edff 619 int iMetric;
leafman 98:9f8bab96edff 620 fscanf(cfile, "metric %d\r\n", &iMetric );
TickTock 141:cf13a632ddb5 621 metric = (bool)iMetric; // This will get re-assigned based on dash selection
leafman 98:9f8bab96edff 622 fscanf(cfile, "firmware %d\r\n", &iMetric );
leafman 98:9f8bab96edff 623 fwCount = iMetric;
TickTock 35:5acbd8a64a89 624 }
TickTock 131:0d926c080a65 625 if(ff>5){
TickTock 131:0d926c080a65 626 int ishowHealth;
TickTock 131:0d926c080a65 627 fscanf(cfile, "showHealth %d\r\n", &ishowHealth );
TickTock 131:0d926c080a65 628 showHealth = (bool)ishowHealth;
TickTock 131:0d926c080a65 629 }
TickTock 140:ab3e94eb0227 630 if(ff>6){
TickTock 140:ab3e94eb0227 631 int iBrakeMon;
TickTock 140:ab3e94eb0227 632 fscanf(cfile, "brakeMon %d\r\n", &iBrakeMon );
TickTock 140:ab3e94eb0227 633 brakeMon = (bool)iBrakeMon;
TickTock 141:cf13a632ddb5 634 fscanf(cfile, "brkMonRate %d\r\n", &brkMonRate );
TickTock 141:cf13a632ddb5 635 fscanf(cfile, "brkMonThr %d\r\n", &brkMonThr );
TickTock 140:ab3e94eb0227 636 }
TickTock 149:e9739523109f 637 if(ff>7){
TickTock 149:e9739523109f 638 for(char i=0;i<8;i++){
TickTock 149:e9739523109f 639 fscanf(cfile, "usrMsgId %4x\r\n", &uMsgId[i] );
TickTock 149:e9739523109f 640 }
TickTock 149:e9739523109f 641 }
TickTock 23:cd03f9c3395e 642 fclose(cfile);
TickTock 149:e9739523109f 643 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 644 //Something wrong. Load defaults
TickTock 148:6e3b9135fad2 645 printf("Invalid config file. Loading defaults.\n");
TickTock 148:6e3b9135fad2 646 wait(3);
TickTock 148:6e3b9135fad2 647 ff=8;
TickTock 148:6e3b9135fad2 648 tt.x0_off=5732;
TickTock 148:6e3b9135fad2 649 tt.y0_off=34009;
TickTock 148:6e3b9135fad2 650 tt.x0_pp=77;
TickTock 148:6e3b9135fad2 651 tt.y0_pp=106;
TickTock 148:6e3b9135fad2 652 tt.x1_off=33955;
TickTock 148:6e3b9135fad2 653 tt.y1_off=6310;
TickTock 148:6e3b9135fad2 654 tt.x1_pp=80;
TickTock 148:6e3b9135fad2 655 tt.y1_pp=104;
TickTock 148:6e3b9135fad2 656 tt.x_mid=31986;
TickTock 148:6e3b9135fad2 657 dMode[0]=4;
TickTock 148:6e3b9135fad2 658 dMode[1]=2;
TickTock 148:6e3b9135fad2 659 ledHi=0.800;
TickTock 148:6e3b9135fad2 660 ledLo=0.100;
TickTock 148:6e3b9135fad2 661 pollInt=300;
TickTock 148:6e3b9135fad2 662 scale12V=16.20;
TickTock 148:6e3b9135fad2 663 skin=0;
TickTock 148:6e3b9135fad2 664 dtePeriod=14;
TickTock 148:6e3b9135fad2 665 debugMode=false;
TickTock 148:6e3b9135fad2 666 metric=false;
TickTock 148:6e3b9135fad2 667 fwCount=1;
TickTock 148:6e3b9135fad2 668 showHealth=true;
TickTock 148:6e3b9135fad2 669 brakeMon=true;
TickTock 148:6e3b9135fad2 670 brkMonRate=400000;
TickTock 148:6e3b9135fad2 671 brkMonThr=4000;
TickTock 149:e9739523109f 672 uMsgId[0]=0x5103;
TickTock 149:e9739523109f 673 uMsgId[1]=0x50a3;
TickTock 149:e9739523109f 674 uMsgId[2]=0x54a4;
TickTock 149:e9739523109f 675 uMsgId[3]=0x54b4;
TickTock 149:e9739523109f 676 uMsgId[4]=0x54c0;
TickTock 149:e9739523109f 677 uMsgId[5]=0x55b4;
TickTock 149:e9739523109f 678 uMsgId[6]=0x0000;
TickTock 149:e9739523109f 679 uMsgId[7]=0x0000;
TickTock 148:6e3b9135fad2 680 }
TickTock 149:e9739523109f 681
TickTock 140:ab3e94eb0227 682 if(ff<7){//If not latest format, save as latest format
TickTock 35:5acbd8a64a89 683 saveConfig();
TickTock 116:5cd72bae7c12 684 printMsg("Config file format updated.\n"); // config forat updates
TickTock 48:d1ce92104a1f 685 }
TickTock 116:5cd72bae7c12 686 printMsg("Config file loaded.\n"); // config file loaded
TickTock 23:cd03f9c3395e 687 }
TickTock 23:cd03f9c3395e 688 }
TickTock 25:ddf0ec209f03 689
TickTock 25:ddf0ec209f03 690 void upDate(unsigned char field, bool upDownBar){
TickTock 25:ddf0ec209f03 691 struct tm t; // pointer to a static tm structure
TickTock 25:ddf0ec209f03 692 time_t seconds ;
TickTock 25:ddf0ec209f03 693 seconds = time(NULL);
TickTock 25:ddf0ec209f03 694 t = *localtime(&seconds) ;
TickTock 25:ddf0ec209f03 695 switch(field){
TickTock 25:ddf0ec209f03 696 case 0: // year
TickTock 25:ddf0ec209f03 697 if (upDownBar) {
TickTock 25:ddf0ec209f03 698 t.tm_year = t.tm_year+1;
TickTock 25:ddf0ec209f03 699 } else {
TickTock 25:ddf0ec209f03 700 t.tm_year = t.tm_year-1;
TickTock 25:ddf0ec209f03 701 }
TickTock 25:ddf0ec209f03 702 break;
TickTock 25:ddf0ec209f03 703 case 1: // month
TickTock 25:ddf0ec209f03 704 if (upDownBar) {
TickTock 25:ddf0ec209f03 705 t.tm_mon = (t.tm_mon<12)?t.tm_mon+1:1;
TickTock 25:ddf0ec209f03 706 } else {
TickTock 25:ddf0ec209f03 707 t.tm_mon = (t.tm_mon>2)?t.tm_mon-1:12;
TickTock 25:ddf0ec209f03 708 }
TickTock 25:ddf0ec209f03 709 break;
TickTock 25:ddf0ec209f03 710 case 2: // day
TickTock 25:ddf0ec209f03 711 if (upDownBar) {
TickTock 25:ddf0ec209f03 712 t.tm_mday = (t.tm_mday<31)?t.tm_mday+1:1;
TickTock 25:ddf0ec209f03 713 } else {
TickTock 25:ddf0ec209f03 714 t.tm_mday = (t.tm_mday>2)?t.tm_mday-1:31;
TickTock 25:ddf0ec209f03 715 }
TickTock 25:ddf0ec209f03 716 break;
TickTock 25:ddf0ec209f03 717 case 3: // hour
TickTock 25:ddf0ec209f03 718 if (upDownBar) {
TickTock 25:ddf0ec209f03 719 t.tm_hour = (t.tm_hour<23)?t.tm_hour+1:0;
TickTock 25:ddf0ec209f03 720 } else {
TickTock 25:ddf0ec209f03 721 t.tm_hour = (t.tm_hour>1)?t.tm_hour-1:23;
TickTock 25:ddf0ec209f03 722 }
TickTock 25:ddf0ec209f03 723 break;
TickTock 25:ddf0ec209f03 724 case 4: // minute
TickTock 25:ddf0ec209f03 725 if (upDownBar) {
TickTock 25:ddf0ec209f03 726 t.tm_min = (t.tm_min<59)?t.tm_min+1:0;
TickTock 25:ddf0ec209f03 727 } else {
TickTock 25:ddf0ec209f03 728 t.tm_min = (t.tm_min>1)?t.tm_min-1:59;
TickTock 25:ddf0ec209f03 729 }
TickTock 25:ddf0ec209f03 730 break;
TickTock 25:ddf0ec209f03 731 case 5: // second
TickTock 25:ddf0ec209f03 732 if (upDownBar) {
TickTock 25:ddf0ec209f03 733 t.tm_sec = (t.tm_sec<59)?t.tm_sec+1:0;
TickTock 25:ddf0ec209f03 734 } else {
TickTock 25:ddf0ec209f03 735 t.tm_sec = (t.tm_sec>1)?t.tm_sec-1:59;
TickTock 25:ddf0ec209f03 736 }
TickTock 25:ddf0ec209f03 737 break;
TickTock 25:ddf0ec209f03 738 default:
TickTock 25:ddf0ec209f03 739 break;
TickTock 25:ddf0ec209f03 740 }
TickTock 25:ddf0ec209f03 741 set_time(mktime(&t));
TickTock 25:ddf0ec209f03 742 }
TickTock 25:ddf0ec209f03 743
TickTock 39:eef8beac7411 744 void logPackVoltages() { // Turbo3 - routine to dump CP values to text file
TickTock 39:eef8beac7411 745 char sTemp[40];
TickTock 39:eef8beac7411 746 struct tm t; // pointer to a static tm structure
TickTock 39:eef8beac7411 747 short unsigned max, min, jv, i, bd;
TickTock 39:eef8beac7411 748 unsigned avg;
TickTock 119:0e2b641e98a2 749 unsigned short gids, SOC, packV_x2;
TickTock 140:ab3e94eb0227 750 unsigned long odo;
TickTock 119:0e2b641e98a2 751 signed short packA_x2;
TickTock 39:eef8beac7411 752 time_t seconds ;
TickTock 39:eef8beac7411 753
TickTock 39:eef8beac7411 754 CANMessage msg;
TickTock 39:eef8beac7411 755
TickTock 39:eef8beac7411 756 seconds = time(NULL); // Turbo3
TickTock 39:eef8beac7411 757 t = *localtime(&seconds) ; // Turbo3
TickTock 39:eef8beac7411 758
TickTock 39:eef8beac7411 759 msg = lastMsg[indexLastMsg[0x5bc]]; //Get gids
TickTock 39:eef8beac7411 760 gids = (msg.data[0]<<2)+(msg.data[1]>>6);
TickTock 140:ab3e94eb0227 761 msg = lastMsg[indexLastMsg[0x5c5]]; //Get odometer
TickTock 140:ab3e94eb0227 762 odo = (msg.data[1]<16)+(msg.data[2]<<8)+msg.data[3];
TickTock 39:eef8beac7411 763 msg = lastMsg[indexLastMsg[0x55b]]; //Get SOC
TickTock 39:eef8beac7411 764 SOC = (msg.data[0]<<2)+(msg.data[1]>>6);
TickTock 39:eef8beac7411 765 msg = lastMsg[indexLastMsg[0x1db]]; //Get pack volts
TickTock 119:0e2b641e98a2 766 packV_x2 = (msg.data[2]<<2)+(msg.data[3]>>6);
TickTock 119:0e2b641e98a2 767 packA_x2 = (msg.data[0]<<3)+(msg.data[1]>>5);
TickTock 119:0e2b641e98a2 768 if (packA_x2 & 0x400) packA_x2 |= 0xf800;
TickTock 39:eef8beac7411 769
TickTock 39:eef8beac7411 770 max=0;
TickTock 39:eef8beac7411 771 min=9999;
TickTock 39:eef8beac7411 772 avg=0;
TickTock 92:935adef49ea4 773 for(i=0; i<96; i++) {
TickTock 124:0d622967b764 774 bd=(battData[BatDataBaseG2*7+i*2+3]<<8)+battData[BatDataBaseG2*7+i*2+4];
TickTock 39:eef8beac7411 775 avg+=bd;
TickTock 39:eef8beac7411 776 if(bd>max) max=bd;
TickTock 39:eef8beac7411 777 if(bd<min) min=bd;
TickTock 39:eef8beac7411 778 }
TickTock 39:eef8beac7411 779 avg /= 96;
TickTock 39:eef8beac7411 780 if(min<3713) {
TickTock 39:eef8beac7411 781 jv=avg-(max-avg)*1.5;
TickTock 39:eef8beac7411 782 } else { // Only compute judgement value if min cellpair meets <= 3712mV requirement
TickTock 39:eef8beac7411 783 jv=0;
TickTock 39:eef8beac7411 784 }
TickTock 39:eef8beac7411 785
TickTock 110:ffddff3ad2f2 786 FIL bfile;
TickTock 110:ffddff3ad2f2 787 FRESULT bfr;
TickTock 110:ffddff3ad2f2 788 bfr = f_open(&bfile,"batvolt.txt",FA_WRITE|FA_OPEN_ALWAYS);
TickTock 110:ffddff3ad2f2 789 if(bfr==FR_OK) {
TickTock 110:ffddff3ad2f2 790 f_lseek(&bfile,0xffffffff); // go to end of file to append
TickTock 39:eef8beac7411 791 strftime(sTemp, 40, "%a %m/%d/%Y %X", &t);
TickTock 110:ffddff3ad2f2 792 f_printf(&bfile,"%s,",sTemp);
TickTock 140:ab3e94eb0227 793 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 794 f_printf(&bfile,"%s,",sTemp);
TickTock 124:0d622967b764 795 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 796 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 797 for(i=0; i<96; i++) {
TickTock 124:0d622967b764 798 bd=(battData[BatDataBaseG2*7+i*2+3]<<8)+battData[BatDataBaseG2*7+i*2+4];
TickTock 110:ffddff3ad2f2 799 f_printf(&bfile,",%d",bd);
TickTock 108:29b5a760adc2 800 }
TickTock 110:ffddff3ad2f2 801 f_printf(&bfile,"\r\n");
TickTock 110:ffddff3ad2f2 802 f_close(&bfile);
TickTock 110:ffddff3ad2f2 803 }
TickTock 108:29b5a760adc2 804 logCP=false;
TickTock 108:29b5a760adc2 805 showCP=true;
TickTock 108:29b5a760adc2 806 }
TickTock 108:29b5a760adc2 807
TickTock 108:29b5a760adc2 808 void tripLog() { // Daily log
TickTock 110:ffddff3ad2f2 809 char sTemp[40];
TickTock 108:29b5a760adc2 810 struct tm t; // pointer to a static tm structure
TickTock 108:29b5a760adc2 811 short unsigned max, min, jv, i, bd;
TickTock 108:29b5a760adc2 812 unsigned avg;
TickTock 119:0e2b641e98a2 813 unsigned short gids, SOC, packV_x2;
TickTock 140:ab3e94eb0227 814 unsigned long odo;
TickTock 119:0e2b641e98a2 815 signed short packA_x2;
TickTock 39:eef8beac7411 816 time_t seconds ;
TickTock 39:eef8beac7411 817
TickTock 39:eef8beac7411 818 CANMessage msg;
TickTock 39:eef8beac7411 819
TickTock 39:eef8beac7411 820 seconds = time(NULL); // Turbo3
TickTock 39:eef8beac7411 821 t = *localtime(&seconds) ; // Turbo3
TickTock 39:eef8beac7411 822
TickTock 39:eef8beac7411 823 msg = lastMsg[indexLastMsg[0x5bc]]; //Get gids
TickTock 39:eef8beac7411 824 gids = (msg.data[0]<<2)+(msg.data[1]>>6);
TickTock 140:ab3e94eb0227 825 msg = lastMsg[indexLastMsg[0x5c5]]; //Get odometer
TickTock 140:ab3e94eb0227 826 odo = (msg.data[1]<16)+(msg.data[2]<<8)+msg.data[3];
TickTock 39:eef8beac7411 827 msg = lastMsg[indexLastMsg[0x55b]]; //Get SOC
TickTock 39:eef8beac7411 828 SOC = (msg.data[0]<<2)+(msg.data[1]>>6);
TickTock 39:eef8beac7411 829 msg = lastMsg[indexLastMsg[0x1db]]; //Get pack volts
TickTock 119:0e2b641e98a2 830 packV_x2 = (msg.data[2]<<2)+(msg.data[3]>>6);
TickTock 119:0e2b641e98a2 831 packA_x2 = (msg.data[0]<<3)+(msg.data[1]>>5);
TickTock 119:0e2b641e98a2 832 if (packA_x2 & 0x400) packA_x2 |= 0xf800;
TickTock 39:eef8beac7411 833
TickTock 39:eef8beac7411 834 max=0;
TickTock 39:eef8beac7411 835 min=9999;
TickTock 39:eef8beac7411 836 avg=0;
TickTock 39:eef8beac7411 837 for(i=0; i<96; i++) {
TickTock 124:0d622967b764 838 bd=(battData[BatDataBaseG2*7+i*2+3]<<8)+battData[BatDataBaseG2*7+i*2+4];
TickTock 39:eef8beac7411 839 avg+=bd;
TickTock 39:eef8beac7411 840 if(bd>max) max=bd;
TickTock 39:eef8beac7411 841 if(bd<min) min=bd;
TickTock 39:eef8beac7411 842 }
TickTock 39:eef8beac7411 843 avg /= 96;
TickTock 39:eef8beac7411 844 if(min<3713) {
TickTock 39:eef8beac7411 845 jv=avg-(max-avg)*1.5;
TickTock 39:eef8beac7411 846 } else { // Only compute judgement value if min cellpair meets <= 3712mV requirement
TickTock 39:eef8beac7411 847 jv=0;
TickTock 39:eef8beac7411 848 }
TickTock 39:eef8beac7411 849
TickTock 110:ffddff3ad2f2 850 FIL bfile;
TickTock 110:ffddff3ad2f2 851 FRESULT bfr;
TickTock 111:d1559bb25c43 852 bfr = f_open(&bfile,"triplog.txt",FA_WRITE|FA_OPEN_ALWAYS);
TickTock 110:ffddff3ad2f2 853 if(bfr==FR_OK) {
TickTock 110:ffddff3ad2f2 854 f_lseek(&bfile,0xffffffff); // go to end of file to append
TickTock 39:eef8beac7411 855 strftime(sTemp, 40, "%a %m/%d/%Y %X", &t);
TickTock 110:ffddff3ad2f2 856 f_printf(&bfile,"%s,",sTemp);
TickTock 148:6e3b9135fad2 857 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 858 f_printf(&bfile,"%s,",sTemp);
TickTock 124:0d622967b764 859 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 860 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 861 for(i=0; i<96; i++) {
TickTock 124:0d622967b764 862 bd=(battData[BatDataBaseG2*7+i*2+3]<<8)+battData[BatDataBaseG2*7+i*2+4];
TickTock 110:ffddff3ad2f2 863 f_printf(&bfile,",%d",bd);
TickTock 142:c1a11d6f181c 864 }
TickTock 122:138a40892a4c 865 // temporariliy dump everything
TickTock 142:c1a11d6f181c 866 /*for(i=0; i<BatDataBufMax; i++) {
TickTock 131:0d926c080a65 867 sprintf(sTemp,",%02x",battData[i]);
TickTock 131:0d926c080a65 868 f_printf(&bfile,"%s",sTemp);
TickTock 142:c1a11d6f181c 869 }*/
TickTock 122:138a40892a4c 870
TickTock 110:ffddff3ad2f2 871 f_printf(&bfile,"\r\n");
TickTock 110:ffddff3ad2f2 872 f_close(&bfile);
TickTock 39:eef8beac7411 873 }
TickTock 39:eef8beac7411 874 }
TickTock 25:ddf0ec209f03 875
leafman 98:9f8bab96edff 876 //LM - updates firmware off a usb key, eliminating the need to plug
leafman 98:9f8bab96edff 877 //the CANary into a computer for updates.
leafman 98:9f8bab96edff 878 void updateFirmware()
leafman 98:9f8bab96edff 879 {
TickTock 143:88b5155622a5 880 FIL efile; // external usb file
TickTock 111:d1559bb25c43 881 FRESULT sfr; // external file access flags
TickTock 111:d1559bb25c43 882 unsigned int bytesRW;
TickTock 111:d1559bb25c43 883 char sTemp[40];
TickTock 131:0d926c080a65 884 const int bufSize = 2048;
TickTock 131:0d926c080a65 885 char buffer[bufSize];
TickTock 143:88b5155622a5 886 FILE *lfile;
TickTock 131:0d926c080a65 887
TickTock 131:0d926c080a65 888 // Check for config file on USB drive
TickTock 143:88b5155622a5 889 sfr = f_open(&efile,"CONFIG.TXT",FA_READ|FA_OPEN_EXISTING);
TickTock 131:0d926c080a65 890 if(sfr == FR_OK)
TickTock 131:0d926c080a65 891 {
TickTock 131:0d926c080a65 892 printf("Copy config file from USB\n");
TickTock 143:88b5155622a5 893 lfile = fopen("/local/CONFIG.TXT", "w");
TickTock 147:e0f1c84c62a6 894 if(lfile != NULL) {
TickTock 147:e0f1c84c62a6 895 while (!f_eof(&efile))
TickTock 147:e0f1c84c62a6 896 {
TickTock 147:e0f1c84c62a6 897 sfr=f_read(&efile,&buffer,bufSize,&bytesRW);
TickTock 147:e0f1c84c62a6 898 fwrite(buffer, 1, bytesRW, lfile);
TickTock 147:e0f1c84c62a6 899 }
TickTock 147:e0f1c84c62a6 900 fflush(lfile);
TickTock 147:e0f1c84c62a6 901 fclose(lfile);
TickTock 131:0d926c080a65 902 }
TickTock 143:88b5155622a5 903 f_close(&efile);
TickTock 148:6e3b9135fad2 904 readConfig();
TickTock 147:e0f1c84c62a6 905 wait(2);
TickTock 143:88b5155622a5 906 }
TickTock 147:e0f1c84c62a6 907
TickTock 143:88b5155622a5 908 sfr = f_open(&efile,"firmware.bin",FA_READ|FA_OPEN_EXISTING);
TickTock 111:d1559bb25c43 909 if(sfr != FR_OK)
TickTock 99:c05abf8e1cdc 910 {
TickTock 137:70853cf5a30f 911 printf("Couldn't find firmware.bin\n");
TickTock 108:29b5a760adc2 912 wait(3);
TickTock 100:63a7456fc972 913 lastDMode[whichTouched]=99;//force refresh
TickTock 99:c05abf8e1cdc 914 return;
TickTock 99:c05abf8e1cdc 915 }
leafman 98:9f8bab96edff 916 fwCount ++;
TickTock 148:6e3b9135fad2 917 saveConfig();
leafman 98:9f8bab96edff 918 //delete all bin files in /local
leafman 98:9f8bab96edff 919 DIR *dir;
leafman 98:9f8bab96edff 920 struct dirent *ent;
leafman 98:9f8bab96edff 921 printf("Starting update\n");
leafman 98:9f8bab96edff 922 printf("deleting old firmware files\n");
leafman 98:9f8bab96edff 923 if ((dir = opendir ("/local/")) != NULL) {
TickTock 109:3e6f0e8fca0d 924 // print all the files and directories within directory
leafman 98:9f8bab96edff 925 while ((ent = readdir (dir)) != NULL) {
leafman 98:9f8bab96edff 926 //printf("FILE: %s\n",ent->d_name);
leafman 98:9f8bab96edff 927 char dest[4] = "";
leafman 98:9f8bab96edff 928 strncat(dest, &ent->d_name[strlen(ent->d_name)-3],3);
leafman 98:9f8bab96edff 929 dest[0] = tolower(dest[0]);
leafman 98:9f8bab96edff 930 dest[1] = tolower(dest[1]);
leafman 98:9f8bab96edff 931 dest[2] = tolower(dest[2]);
leafman 98:9f8bab96edff 932 if(strcmp(dest,"bin")==0)
leafman 98:9f8bab96edff 933 {
leafman 98:9f8bab96edff 934 sprintf(sTemp,"/local/%s",ent->d_name);
leafman 98:9f8bab96edff 935 int result = remove(sTemp);
leafman 98:9f8bab96edff 936 printf("REMOVED: %s",ent->d_name);
leafman 98:9f8bab96edff 937 }
leafman 98:9f8bab96edff 938 }
leafman 98:9f8bab96edff 939 closedir (dir);
leafman 98:9f8bab96edff 940 } else {
TickTock 109:3e6f0e8fca0d 941 //could not open directory
leafman 98:9f8bab96edff 942 printf("Couldnt open folder");
TickTock 108:29b5a760adc2 943 wait(3);
leafman 98:9f8bab96edff 944 return;
leafman 98:9f8bab96edff 945 }
leafman 98:9f8bab96edff 946 printf("copying new firmware\n");
leafman 98:9f8bab96edff 947 tt.cls();
leafman 98:9f8bab96edff 948 //Copy the new firmware from usb->local
TickTock 131:0d926c080a65 949 //The newest bin file is the one that is used by the mbed
leafman 98:9f8bab96edff 950 sprintf(sTemp,"/local/fw%d.bin",fwCount);
leafman 98:9f8bab96edff 951 printf("Writing %s\n",sTemp);
leafman 98:9f8bab96edff 952 wait(2);
TickTock 143:88b5155622a5 953 lfile = fopen(sTemp, "wb");
TickTock 143:88b5155622a5 954 if(lfile == NULL)
leafman 98:9f8bab96edff 955 {
TickTock 131:0d926c080a65 956 printf("Couldn't Open Destination\n");
TickTock 108:29b5a760adc2 957 wait(3);
leafman 98:9f8bab96edff 958 return;
leafman 98:9f8bab96edff 959 }
TickTock 97:a25940fd7b5b 960
TickTock 143:88b5155622a5 961 while (!f_eof(&efile))
leafman 98:9f8bab96edff 962 {
TickTock 143:88b5155622a5 963 sfr=f_read(&efile,&buffer,bufSize,&bytesRW);
TickTock 143:88b5155622a5 964 fwrite(buffer, 1, bytesRW, lfile);
leafman 98:9f8bab96edff 965 }
leafman 98:9f8bab96edff 966
TickTock 143:88b5155622a5 967 fflush(lfile);
TickTock 143:88b5155622a5 968 fclose(lfile);
TickTock 143:88b5155622a5 969 f_close(&efile);
leafman 98:9f8bab96edff 970 tt.cls();
leafman 98:9f8bab96edff 971 printf("Succesful\n\n");
TickTock 108:29b5a760adc2 972 printf("Rebooting in 3 seconds\n");
TickTock 108:29b5a760adc2 973 wait(3);
leafman 98:9f8bab96edff 974 //Now run new firmware
TickTock 111:d1559bb25c43 975 mbed_reset();
TickTock 99:c05abf8e1cdc 976 }
TickTock 108:29b5a760adc2 977
TickTock 108:29b5a760adc2 978 bool detectUSB(void){
TickTock 130:1a9d2a6d99ce 979 FIL tfile; // external usb file
TickTock 111:d1559bb25c43 980 bool usbEn = (f_open(&tfile,"usb.det",FA_WRITE|FA_OPEN_ALWAYS)==FR_OK);
TickTock 108:29b5a760adc2 981 if(usbEn){
TickTock 111:d1559bb25c43 982 f_close(&tfile);
TickTock 111:d1559bb25c43 983 f_unlink("usb.det");
TickTock 111:d1559bb25c43 984 }
TickTock 130:1a9d2a6d99ce 985 return(usbEn);
TickTock 108:29b5a760adc2 986 }
TickTock 131:0d926c080a65 987
TickTock 140:ab3e94eb0227 988 void chirp(void){
TickTock 140:ab3e94eb0227 989 static unsigned short counter=0;
TickTock 140:ab3e94eb0227 990
TickTock 140:ab3e94eb0227 991 if(chirpInt>0){
TickTock 141:cf13a632ddb5 992 if(++counter>chirpInt){
TickTock 141:cf13a632ddb5 993 spkr.beep(500,0.015);
TickTock 140:ab3e94eb0227 994 counter=0;
TickTock 140:ab3e94eb0227 995 }
TickTock 148:6e3b9135fad2 996 }else{
TickTock 148:6e3b9135fad2 997 counter=0;
TickTock 140:ab3e94eb0227 998 }
TickTock 140:ab3e94eb0227 999 }
TickTock 140:ab3e94eb0227 1000
TickTock 149:e9739523109f 1001 float airDrag(float F)
TickTock 149:e9739523109f 1002 {
TickTock 149:e9739523109f 1003 float drag_F[16] = {1.47,1.39,1.363,1.337,1.312,1.288,1.265,1.243,1.221,1.2,1.18,1.161,1.142,1.124,1.106,1.034};
TickTock 149:e9739523109f 1004 float temp_F[16] = {-31,-4,5,14,23,32,41,50,59,68,77,86,95,104,113,149};
TickTock 149:e9739523109f 1005 char ii=0;
TickTock 149:e9739523109f 1006 float drag;
TickTock 149:e9739523109f 1007 while(ambient_F<=temp_F[++ii]) { } // Find section in table
TickTock 149:e9739523109f 1008 drag=(ambient_F-temp_F[ii]);
TickTock 149:e9739523109f 1009 drag/=(temp_F[ii-1]-temp_F[ii]);
TickTock 149:e9739523109f 1010 drag*=(drag_F[ii-1]-drag_F[ii]);
TickTock 149:e9739523109f 1011 drag+=drag_F[ii];
TickTock 149:e9739523109f 1012 return drag;
TickTock 149:e9739523109f 1013 }
TickTock 149:e9739523109f 1014
TickTock 131:0d926c080a65 1015 //Sample CONFIG.TXT
TickTock 131:0d926c080a65 1016 /*
TickTock 144:b0c9d30dd346 1017 format 7
TickTock 131:0d926c080a65 1018 x0_off 5732
TickTock 131:0d926c080a65 1019 y0_off 34009
TickTock 131:0d926c080a65 1020 x0_pp 77
TickTock 131:0d926c080a65 1021 y0_pp 106
TickTock 131:0d926c080a65 1022 x1_off 33955
TickTock 131:0d926c080a65 1023 y1_off 6310
TickTock 131:0d926c080a65 1024 x1_pp 80
TickTock 131:0d926c080a65 1025 y1_pp 104
TickTock 131:0d926c080a65 1026 x_mid 31986
TickTock 131:0d926c080a65 1027 dMode0 4
TickTock 131:0d926c080a65 1028 dMode1 2
TickTock 131:0d926c080a65 1029 ledHi 0.800
TickTock 131:0d926c080a65 1030 ledLo 0.100
TickTock 131:0d926c080a65 1031 pollInt 300
TickTock 131:0d926c080a65 1032 scale12V 16.20
TickTock 131:0d926c080a65 1033 skin 0
TickTock 131:0d926c080a65 1034 dtePeriod 14
TickTock 131:0d926c080a65 1035 DebugMode 0
TickTock 144:b0c9d30dd346 1036 metric 0
TickTock 148:6e3b9135fad2 1037 firmware 1
TickTock 131:0d926c080a65 1038 showHealth 1
TickTock 141:cf13a632ddb5 1039 brakeMon 1
TickTock 141:cf13a632ddb5 1040 brkMonRate 400000
TickTock 144:b0c9d30dd346 1041 brkMonThr 4000
TickTock 149:e9739523109f 1042 */