Dual CANbus monitor and instrumentation cluster
Eagle Schematic and Board design
/media/uploads/TickTock/canaryr5.zip
Parts List
Assembly
1) LCD Displays
I found ribbon cable is a nice way to organize the wires to the displays. You'll need 12 conductors and I connected them in the following order:
1 | LED+ |
2 | LED- |
3 | RSTB |
4 | MOSI |
5 | SCLK |
6 | CSB |
7 | X+ |
8 | X- |
9 | Y+ |
10 | Y- |
11 | VDD |
12 | GND |
First I connected all the GND connections (IM0, IM1, IM3, & 2 GND). 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. Take a break and repeat for the second display. 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.
Once the PCB is populated, solder the LCDs to the PCB. CS0 connects to the right display and CS1 connects to the left.
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. Test all features before installing into the enclosure (gids, cellpair, menu system, logging) since installing and removing from the enclosure is a PITA. |
4) Enclosure
The 3D printer leaves a lot of powder behind - I used a strong spray of water to get it out of all the cracks. The enclosure comes with a rather rough finish. I recommend convincing yourself you like it, then simply lightly sand then paint before assembly. Sanding is very difficult - the nylon is very nicely fused and doesn't want to sand. I tried sandblasting and that didn't work either. I had some limited success with filler and then sanding, but only on the outside - it is too difficult to sand the face.
5) Final Assembly
utility.cpp@80:cf009a64eedd, 2013-04-16 (annotated)
- Committer:
- garygid
- Date:
- Tue Apr 16 21:49:13 2013 +0000
- Revision:
- 80:cf009a64eedd
- Parent:
- 79:24f1793171e7
- Parent:
- 78:a383971fe02f
- Child:
- 83:52b1f330a62d
Merge with v78
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
TickTock | 13:62e0f7f39ff5 | 1 | // utility.cpp |
TickTock | 13:62e0f7f39ff5 | 2 | #include "utility.h" |
TickTock | 13:62e0f7f39ff5 | 3 | |
TickTock | 13:62e0f7f39ff5 | 4 | void mbed_reset(); |
TickTock | 22:a43df3905863 | 5 | |
TickTock | 13:62e0f7f39ff5 | 6 | void RTC_IRQHandler() { |
TickTock | 13:62e0f7f39ff5 | 7 | timer.reset(); // zero ms at the-seconds-tic |
TickTock | 20:3bf176d14b14 | 8 | canIdle=(++secsNoMsg>canTimeout)?true:false; |
TickTock | 20:3bf176d14b14 | 9 | userIdle=(++secsNoTouch>userTimeout)?true:false; |
TickTock | 13:62e0f7f39ff5 | 10 | LPC_RTC->ILR |= (1<<0); // clear interrupt to prepare for next |
TickTock | 34:4751a8259b18 | 11 | tick=true; |
garygid | 69:6bfdfc002036 | 12 | // will use this to generate a logTP() just before the next Message received. |
garygid | 69:6bfdfc002036 | 13 | if( (time(NULL) % 60) == 0) ZeroSecTick = true; // gg - at 0-second of each minute |
TickTock | 13:62e0f7f39ff5 | 14 | } |
TickTock | 13:62e0f7f39ff5 | 15 | |
TickTock | 37:fea2c1d52c5f | 16 | void RTC_Init (void) { |
TickTock | 13:62e0f7f39ff5 | 17 | LPC_RTC->ILR=0x00; // set up the RTC interrupts |
TickTock | 13:62e0f7f39ff5 | 18 | LPC_RTC->CIIR=0x01; // interrupts each second |
TickTock | 13:62e0f7f39ff5 | 19 | LPC_RTC->CCR = 0x01; // Clock enable |
TickTock | 13:62e0f7f39ff5 | 20 | //NVIC_SetPriority( RTC_IRQn, 10 ); |
TickTock | 13:62e0f7f39ff5 | 21 | NVIC_EnableIRQ( RTC_IRQn ); |
TickTock | 13:62e0f7f39ff5 | 22 | } |
TickTock | 13:62e0f7f39ff5 | 23 | |
TickTock | 13:62e0f7f39ff5 | 24 | void logMsg (char *msg) { |
TickTock | 13:62e0f7f39ff5 | 25 | strcpy(displayLog[displayLoc],msg); |
TickTock | 13:62e0f7f39ff5 | 26 | displayLoc=displayLoc>17?0:displayLoc+1; |
TickTock | 13:62e0f7f39ff5 | 27 | } |
TickTock | 13:62e0f7f39ff5 | 28 | |
TickTock | 13:62e0f7f39ff5 | 29 | void touch_ISR(){ |
TickTock | 37:fea2c1d52c5f | 30 | //LPC_GPIOINT->IO2IntClr = (LPC_GPIOINT->IO2IntStatR | LPC_GPIOINT->IO2IntStatF); // seems to work without so maybe not necessary (performed inInterruptIn handler?) |
TickTock | 35:5acbd8a64a89 | 31 | touched=true; // just set flag - touch screen algorythm is long and we don't want to block other interrupts |
TickTock | 13:62e0f7f39ff5 | 32 | } |
TickTock | 13:62e0f7f39ff5 | 33 | |
TickTock | 13:62e0f7f39ff5 | 34 | unsigned short getTimeStamp() { |
TickTock | 13:62e0f7f39ff5 | 35 | unsigned short msec = timer.read_ms() ; // read ms from the timer |
TickTock | 13:62e0f7f39ff5 | 36 | unsigned long secs = time(NULL); // seconds past 12:00:00 AM 1 Jan 1900 |
TickTock | 13:62e0f7f39ff5 | 37 | unsigned short isecs = secs%60 ; // modulo 60 for 0-59 seconds from RTC |
TickTock | 13:62e0f7f39ff5 | 38 | return ((isecs<<10)+msec) ; // return the two byte time stamp |
TickTock | 13:62e0f7f39ff5 | 39 | } |
TickTock | 13:62e0f7f39ff5 | 40 | |
garygid | 79:24f1793171e7 | 41 | //------------------------------------ |
garygid | 79:24f1793171e7 | 42 | // gg - logcan |
TickTock | 13:62e0f7f39ff5 | 43 | void logCan (char mType, CANMessage canRXmsg) { |
garygid | 79:24f1793171e7 | 44 | // re-arranged to put static first |
garygid | 79:24f1793171e7 | 45 | static unsigned char ii = 0; |
garygid | 79:24f1793171e7 | 46 | static unsigned char lasti = 0; // indexindex |
garygid | 79:24f1793171e7 | 47 | static unsigned char bdi=0; |
garygid | 79:24f1793171e7 | 48 | static signed short imotorRPM = 0; |
garygid | 79:24f1793171e7 | 49 | static unsigned short nLost = 0; // gg - overrun |
garygid | 79:24f1793171e7 | 50 | |
garygid | 69:6bfdfc002036 | 51 | char sTemp[40]; |
TickTock | 13:62e0f7f39ff5 | 52 | unsigned char changed,i; |
garygid | 79:24f1793171e7 | 53 | unsigned char ij; |
TickTock | 40:0e6e71a7323f | 54 | signed short packV; |
TickTock | 37:fea2c1d52c5f | 55 | signed short packA; |
TickTock | 40:0e6e71a7323f | 56 | signed long imWs_x4; |
garygid | 69:6bfdfc002036 | 57 | |
garygid | 79:24f1793171e7 | 58 | unsigned short ts = getTimeStamp(); |
TickTock | 36:dbd39c315258 | 59 | secsNoMsg=0; // reset deadman switch |
garygid | 79:24f1793171e7 | 60 | |
TickTock | 13:62e0f7f39ff5 | 61 | if(logOpen){ |
TickTock | 13:62e0f7f39ff5 | 62 | if(canRXmsg.id>0) { |
garygid | 79:24f1793171e7 | 63 | // check to see if buffer is already full (read - write) = 1 |
garygid | 79:24f1793171e7 | 64 | // actually the last buffer location cannot be used because then |
garygid | 79:24f1793171e7 | 65 | // the buffer would look empty after writePointer++ |
garygid | 79:24f1793171e7 | 66 | |
garygid | 79:24f1793171e7 | 67 | //if (((writePointer+maxBufLen-readPointer)%maxBufLen)>(maxBufLen/16)) // modulo is slow? |
garygid | 79:24f1793171e7 | 68 | |
garygid | 79:24f1793171e7 | 69 | // maxBufLen = 512, so pointers are 0 through 511 |
garygid | 79:24f1793171e7 | 70 | if( (readPointer - writePointer) == 1 || (writePointer - readPointer) == (maxBufLen - 1)) { |
garygid | 79:24f1793171e7 | 71 | // the buffer is "full", so Lose this message |
garygid | 79:24f1793171e7 | 72 | |
garygid | 79:24f1793171e7 | 73 | // point to the last-stored message |
garygid | 79:24f1793171e7 | 74 | int tempWritePointer = writePointer - 1 ; |
garygid | 79:24f1793171e7 | 75 | if( tempWritePointer == -1 ) tempWritePointer = maxBufLen - 1; |
garygid | 79:24f1793171e7 | 76 | char strLost[9] ; |
garygid | 79:24f1793171e7 | 77 | |
garygid | 79:24f1793171e7 | 78 | if( nLost == 0 ) { |
garygid | 79:24f1793171e7 | 79 | // this is the first message lost |
garygid | 79:24f1793171e7 | 80 | // and we must overwrite the last message with an FFE comment message |
garygid | 79:24f1793171e7 | 81 | // So, there will be two messages lost as the comment message is laid in. |
garygid | 79:24f1793171e7 | 82 | nLost = 2; |
garygid | 79:24f1793171e7 | 83 | sprintf(strLost,"%s","Lost0002"); // indicate two messages lost |
garygid | 79:24f1793171e7 | 84 | |
garygid | 79:24f1793171e7 | 85 | // overlay the last message with a "Lost0002" comment |
garygid | 79:24f1793171e7 | 86 | writeBuffer[tempWritePointer][0]=0; |
garygid | 79:24f1793171e7 | 87 | writeBuffer[tempWritePointer][1]=(ts&0xff00)>>8; // Time Stamp (2 bytes_ |
garygid | 79:24f1793171e7 | 88 | writeBuffer[tempWritePointer][2]=(ts&0x00ff); |
garygid | 79:24f1793171e7 | 89 | writeBuffer[tempWritePointer][3]=0xfe; // MsgID, low byte |
garygid | 79:24f1793171e7 | 90 | writeBuffer[tempWritePointer][4]=0xff; // Len nibble, and MsgID high nibble |
garygid | 79:24f1793171e7 | 91 | |
garygid | 79:24f1793171e7 | 92 | for(i=5;i<13;i++){ |
garygid | 79:24f1793171e7 | 93 | writeBuffer[tempWritePointer][i]= strLost[i-5]; |
garygid | 79:24f1793171e7 | 94 | } |
garygid | 79:24f1793171e7 | 95 | } else { |
garygid | 79:24f1793171e7 | 96 | // increment the loat counter |
garygid | 79:24f1793171e7 | 97 | nLost += 1; |
garygid | 79:24f1793171e7 | 98 | |
garygid | 79:24f1793171e7 | 99 | // lay the new count into the comment |
garygid | 79:24f1793171e7 | 100 | sprintf(strLost,"%04d",nLost); |
garygid | 79:24f1793171e7 | 101 | for(i=9;i<13;i++){ |
garygid | 79:24f1793171e7 | 102 | writeBuffer[tempWritePointer][i]= strLost[i-9]; |
garygid | 79:24f1793171e7 | 103 | } |
garygid | 79:24f1793171e7 | 104 | } |
garygid | 79:24f1793171e7 | 105 | } else { |
garygid | 79:24f1793171e7 | 106 | // is room to insert the message |
garygid | 79:24f1793171e7 | 107 | // get it inserted quickly |
garygid | 79:24f1793171e7 | 108 | writeBuffer[writePointer][0]=mType; |
garygid | 79:24f1793171e7 | 109 | writeBuffer[writePointer][1]=(ts&0xff00)>>8; // Time Stamp (2 bytes_ |
garygid | 79:24f1793171e7 | 110 | writeBuffer[writePointer][2]=(ts&0x00ff); |
garygid | 79:24f1793171e7 | 111 | writeBuffer[writePointer][3]=canRXmsg.id&0xff; // MsgID, low byte |
garygid | 79:24f1793171e7 | 112 | writeBuffer[writePointer][4]=(canRXmsg.id>>8)+(canRXmsg.len<<4); // Len nibble, and MsgID high nibble |
garygid | 79:24f1793171e7 | 113 | for(i=5;i<13;i++){ // Is there a better way to do this? (writeBuffer[writePointer][i]=canRXmsg.data?) |
garygid | 79:24f1793171e7 | 114 | writeBuffer[writePointer][i]=canRXmsg.data[i-5]; |
garygid | 79:24f1793171e7 | 115 | } |
garygid | 79:24f1793171e7 | 116 | //-------------- |
garygid | 79:24f1793171e7 | 117 | // force unused data bytes to FF for CAN-Do compatibility - gg - force FF |
garygid | 79:24f1793171e7 | 118 | if(canRXmsg.len < 8){ |
garygid | 79:24f1793171e7 | 119 | for(i=canRXmsg.len; i<8; i++) { |
garygid | 79:24f1793171e7 | 120 | writeBuffer[writePointer][i+5]=0xFF; |
garygid | 79:24f1793171e7 | 121 | } |
garygid | 79:24f1793171e7 | 122 | } |
garygid | 79:24f1793171e7 | 123 | //-------------- |
garygid | 79:24f1793171e7 | 124 | // note, this is not protected from the interrupt |
garygid | 79:24f1793171e7 | 125 | // due to the nLost code above, this no longer |
garygid | 79:24f1793171e7 | 126 | // overflows to writePointer = readPointer |
garygid | 79:24f1793171e7 | 127 | // which would make the buffer look empty |
garygid | 79:24f1793171e7 | 128 | if (++writePointer >= maxBufLen) { |
garygid | 79:24f1793171e7 | 129 | writePointer = 0; |
garygid | 79:24f1793171e7 | 130 | led3 = !led3; |
garygid | 79:24f1793171e7 | 131 | } |
garygid | 79:24f1793171e7 | 132 | //-------------- |
garygid | 79:24f1793171e7 | 133 | // log a local message if we had lost messages. gg - logcan |
garygid | 79:24f1793171e7 | 134 | if( nLost > 0 ) { |
garygid | 79:24f1793171e7 | 135 | // We previously lost messages that did not get into the buffer |
garygid | 79:24f1793171e7 | 136 | sprintf(sTemp,"-- Write Buffer Lost [%d]\n", nLost); |
garygid | 79:24f1793171e7 | 137 | logMsg(sTemp); // write buffer overrun |
garygid | 79:24f1793171e7 | 138 | spkr.beep(500,0.25); |
garygid | 79:24f1793171e7 | 139 | |
garygid | 79:24f1793171e7 | 140 | nLost = 0 ; |
garygid | 79:24f1793171e7 | 141 | } |
garygid | 79:24f1793171e7 | 142 | //-------------- |
TickTock | 13:62e0f7f39ff5 | 143 | } |
TickTock | 13:62e0f7f39ff5 | 144 | } |
TickTock | 37:fea2c1d52c5f | 145 | } |
garygid | 79:24f1793171e7 | 146 | |
garygid | 79:24f1793171e7 | 147 | //------------------------------- |
garygid | 79:24f1793171e7 | 148 | // Some MsgIDS are FFF and FFE, but this array only holds 0 to 7FF |
garygid | 79:24f1793171e7 | 149 | // so, only remember messages 7FF or less - gg - logging bug |
garygid | 79:24f1793171e7 | 150 | if( canRXmsg.id < 0x800 ) { |
garygid | 79:24f1793171e7 | 151 | // message is 7FF or less - gg - logging bug |
garygid | 79:24f1793171e7 | 152 | |
garygid | 79:24f1793171e7 | 153 | // Check if this MsgID has an associated ii entry |
garygid | 79:24f1793171e7 | 154 | if(indexLastMsg[canRXmsg.id]==0) { |
garygid | 79:24f1793171e7 | 155 | // no ii entry associated with this MsgID |
garygid | 79:24f1793171e7 | 156 | |
garygid | 79:24f1793171e7 | 157 | // BUG: but ii = 0 is a valid entry after this wraps |
garygid | 79:24f1793171e7 | 158 | //ii=ii<99?ii+1:0; |
garygid | 79:24f1793171e7 | 159 | //ii=ii<99?ii+1:1; // FIX: reserve ii = 0 as the "invalid, not used, entry |
garygid | 79:24f1793171e7 | 160 | |
garygid | 79:24f1793171e7 | 161 | if(ii<99) { |
garygid | 79:24f1793171e7 | 162 | // unused entries are available |
garygid | 79:24f1793171e7 | 163 | ii += 1; // use next unused entry |
garygid | 79:24f1793171e7 | 164 | |
garygid | 79:24f1793171e7 | 165 | // sever previous usage, if any |
garygid | 79:24f1793171e7 | 166 | //if( iiUsedBy[ii] != 0 ) indexLastMsg[iiUsedBy[ii]]=0; |
garygid | 79:24f1793171e7 | 167 | |
garygid | 79:24f1793171e7 | 168 | // keep track of what MsgID is using this ii entry |
garygid | 79:24f1793171e7 | 169 | //iiUsedBy[ii]=canRXmsg.id; // future |
garygid | 79:24f1793171e7 | 170 | |
garygid | 79:24f1793171e7 | 171 | indexLastMsg[canRXmsg.id]=ii; // Create MsgID linkage for first message |
garygid | 79:24f1793171e7 | 172 | |
garygid | 79:24f1793171e7 | 173 | // update the entry's data |
garygid | 79:24f1793171e7 | 174 | lastMsg[ii]=canRXmsg; //Store in table |
garygid | 79:24f1793171e7 | 175 | |
garygid | 79:24f1793171e7 | 176 | changed = 0xff ; // all bytes are new, so all changed |
garygid | 79:24f1793171e7 | 177 | msgChanged[ii]=changed; |
garygid | 79:24f1793171e7 | 178 | |
garygid | 79:24f1793171e7 | 179 | } else { |
garygid | 79:24f1793171e7 | 180 | // no more available unused entries |
garygid | 79:24f1793171e7 | 181 | // so just ignore this MsgID for now |
garygid | 79:24f1793171e7 | 182 | // ii = 1; // start to re-use entries |
garygid | 79:24f1793171e7 | 183 | |
garygid | 79:24f1793171e7 | 184 | // BUG: after this wraps to re-use the ii's, the old MsgID |
garygid | 79:24f1793171e7 | 185 | // that was using this ii needs to be invalidated |
garygid | 79:24f1793171e7 | 186 | //indexLastMsg[iiUsedBy[ii]]=0; // invalidate ii entry for old MsgID |
garygid | 79:24f1793171e7 | 187 | } |
TickTock | 40:0e6e71a7323f | 188 | |
garygid | 79:24f1793171e7 | 189 | } else { |
garygid | 79:24f1793171e7 | 190 | // there was an old entry for this MsgID to compare to for changes |
garygid | 79:24f1793171e7 | 191 | ij = indexLastMsg[canRXmsg.id] ; |
garygid | 79:24f1793171e7 | 192 | |
garygid | 79:24f1793171e7 | 193 | // compare the old message with the new one to make the data-changed flags |
garygid | 79:24f1793171e7 | 194 | // BUG?: why do this only if viewing the changedScreen? |
garygid | 79:24f1793171e7 | 195 | if(dMode[0]==changedScreen||dMode[1]==changedScreen){ |
garygid | 79:24f1793171e7 | 196 | |
garygid | 79:24f1793171e7 | 197 | changed=msgChanged[ij]; // why get the old changed bits |
garygid | 79:24f1793171e7 | 198 | // what clears the changed bits, dislaying them on the changedScreen? |
garygid | 79:24f1793171e7 | 199 | |
garygid | 79:24f1793171e7 | 200 | // compare the 8 old and new data bytes for changes |
garygid | 79:24f1793171e7 | 201 | for(i=0;i<8;i++){ |
garygid | 79:24f1793171e7 | 202 | if(lastMsg[ij].data[i]!=canRXmsg.data[i]){ |
garygid | 79:24f1793171e7 | 203 | changed |= 1<<i; |
garygid | 79:24f1793171e7 | 204 | } |
garygid | 79:24f1793171e7 | 205 | } |
garygid | 79:24f1793171e7 | 206 | // store the changes |
garygid | 79:24f1793171e7 | 207 | msgChanged[ij]=changed; |
TickTock | 13:62e0f7f39ff5 | 208 | } |
garygid | 79:24f1793171e7 | 209 | |
garygid | 79:24f1793171e7 | 210 | // after the comparison, if any, update the entry's data |
garygid | 79:24f1793171e7 | 211 | lastMsg[ij]=canRXmsg; // Store in table |
TickTock | 13:62e0f7f39ff5 | 212 | } |
garygid | 79:24f1793171e7 | 213 | } // end of is 7FF or less |
TickTock | 41:8d4609ea7259 | 214 | |
garygid | 79:24f1793171e7 | 215 | //----------------------- |
garygid | 79:24f1793171e7 | 216 | // Miscellaneous on-receive operations below |
garygid | 79:24f1793171e7 | 217 | if((mType==2)&&(canRXmsg.id==0x358)){ // CAR bus |
garygid | 79:24f1793171e7 | 218 | // headlight/turn signal indicator |
garygid | 79:24f1793171e7 | 219 | headlights = (canRXmsg.data[1]&0x80)?true:false; |
TickTock | 41:8d4609ea7259 | 220 | |
garygid | 79:24f1793171e7 | 221 | //----------------- |
garygid | 79:24f1793171e7 | 222 | }else if((mType==1)&&(canRXmsg.id==0x7bb)){ // EV bus |
garygid | 79:24f1793171e7 | 223 | // is battery-response data? 7bb [0]=SeqNum 1 2 [3]=Group |
garygid | 79:24f1793171e7 | 224 | // Need to store all responses |
garygid | 79:24f1793171e7 | 225 | |
garygid | 79:24f1793171e7 | 226 | // the first SeqNum is 10 (less than 20-2F found later) |
TickTock | 13:62e0f7f39ff5 | 227 | if(canRXmsg.data[0]<0x20){ |
garygid | 79:24f1793171e7 | 228 | // the f1rst response in a series |
garygid | 79:24f1793171e7 | 229 | if(canRXmsg.data[3]==2){ //cellpair data Group 2 |
garygid | 79:24f1793171e7 | 230 | bdi=0; // initial SeqNum = 10, so index 0 |
garygid | 79:24f1793171e7 | 231 | // next is 21 to 2F and then 20 to about 2C |
TickTock | 13:62e0f7f39ff5 | 232 | sprintf(sTemp,"Getting cell pair data\n"); |
TickTock | 13:62e0f7f39ff5 | 233 | logMsg(sTemp); |
garygid | 79:24f1793171e7 | 234 | }else if(canRXmsg.data[3]==4){ //temperature data Group 4 |
garygid | 79:24f1793171e7 | 235 | bdi=0x20; // index 0 - 2 from SeqNum 20 - 22 |
TickTock | 13:62e0f7f39ff5 | 236 | sprintf(sTemp,"Getting temperature data\n"); |
TickTock | 13:62e0f7f39ff5 | 237 | logMsg(sTemp); |
garygid | 80:cf009a64eedd | 238 | //}else bdi=0; // strange, BUG? the same as Group 2 |
TickTock | 78:a383971fe02f | 239 | }else bdi=0xff; // ignore other messages (for now) |
garygid | 80:cf009a64eedd | 240 | |
TickTock | 13:62e0f7f39ff5 | 241 | lasti=0; |
TickTock | 13:62e0f7f39ff5 | 242 | } |
garygid | 80:cf009a64eedd | 243 | |
TickTock | 78:a383971fe02f | 244 | if(bdi<0xff){ |
garygid | 80:cf009a64eedd | 245 | // handle just the recognized response |
garygid | 80:cf009a64eedd | 246 | i=canRXmsg.data[0]&0x0f; // lower nibble of D0 is index, 0 to F |
garygid | 80:cf009a64eedd | 247 | if(lasti>i){ //detect rollover to 20 (index 0) and offset index appropriately |
garygid | 80:cf009a64eedd | 248 | bdi=0x10; // adding 10 to the index for CPs |
TickTock | 78:a383971fe02f | 249 | } |
garygid | 80:cf009a64eedd | 250 | lasti=i; //remember the index nibble to detect rollover next time around |
garygid | 80:cf009a64eedd | 251 | i+=bdi; // 0 to F then 10 through about 1C for CPs |
garygid | 80:cf009a64eedd | 252 | // 20 through 22 for the Temperatures (Group 4) |
garygid | 79:24f1793171e7 | 253 | |
garygid | 80:cf009a64eedd | 254 | //-------------- |
garygid | 80:cf009a64eedd | 255 | // detect last response from the Temperature series. |
TickTock | 78:a383971fe02f | 256 | //if(i==22) logCP=true; //Turbo3 |
TickTock | 78:a383971fe02f | 257 | //if( (i==22) && (yesBattLog) ) logCP=true; // only if enabled gg - Batt Log |
TickTock | 78:a383971fe02f | 258 | if(i==22){ |
garygid | 80:cf009a64eedd | 259 | // is the last response from Temperatures |
TickTock | 78:a383971fe02f | 260 | logCP=yesBattLog; // Only log if logging enabled |
TickTock | 78:a383971fe02f | 261 | showCP=true; // Always show |
TickTock | 78:a383971fe02f | 262 | } |
garygid | 79:24f1793171e7 | 263 | |
garygid | 80:cf009a64eedd | 264 | // storing 7 bytes of data from each response (after the SeqNum) |
TickTock | 78:a383971fe02f | 265 | i*=7; |
TickTock | 78:a383971fe02f | 266 | if(i<0xfa){ // Is there a better way to do this? |
garygid | 80:cf009a64eedd | 267 | // for CP data the base is 0, at i is (i*7)+6 and the last is 28*7+6 |
garygid | 80:cf009a64eedd | 268 | // for Temp data, base is 32*7, at i is (i*7)+6 and the last is 34*7+6 |
TickTock | 78:a383971fe02f | 269 | battData[i+0]=canRXmsg.data[1]; |
TickTock | 78:a383971fe02f | 270 | battData[i+1]=canRXmsg.data[2]; |
TickTock | 78:a383971fe02f | 271 | battData[i+2]=canRXmsg.data[3]; |
TickTock | 78:a383971fe02f | 272 | battData[i+3]=canRXmsg.data[4]; |
TickTock | 78:a383971fe02f | 273 | battData[i+4]=canRXmsg.data[5]; |
TickTock | 78:a383971fe02f | 274 | battData[i+5]=canRXmsg.data[6]; |
TickTock | 78:a383971fe02f | 275 | battData[i+6]=canRXmsg.data[7]; |
TickTock | 78:a383971fe02f | 276 | } |
TickTock | 13:62e0f7f39ff5 | 277 | } |
garygid | 79:24f1793171e7 | 278 | |
garygid | 79:24f1793171e7 | 279 | //---------------------- |
garygid | 79:24f1793171e7 | 280 | }else if((mType==1)&&(canRXmsg.id==0x1db)){ // EV bus |
garygid | 79:24f1793171e7 | 281 | // Battery Volts and Amps |
TickTock | 37:fea2c1d52c5f | 282 | packV=((canRXmsg.data[2]<<2)|(canRXmsg.data[3]>>6)); // 1 LSB = 0.5V |
TickTock | 37:fea2c1d52c5f | 283 | packA=((canRXmsg.data[0]<<3)|(canRXmsg.data[1]>>5)); // 1 LSB = 0.5A |
TickTock | 37:fea2c1d52c5f | 284 | if(packA>0x03ff){ |
TickTock | 37:fea2c1d52c5f | 285 | packA|=0xf800;//extend sign; |
TickTock | 37:fea2c1d52c5f | 286 | } |
TickTock | 40:0e6e71a7323f | 287 | imWs_x4 = packV; // Volts*milliSeconds*2 |
TickTock | 40:0e6e71a7323f | 288 | imWs_x4 *= -packA; // milliWattseconds*4 |
TickTock | 41:8d4609ea7259 | 289 | if (!((imotorRPM<2)&&(imWs_x4<0))){ //Ignore if charging from wall |
TickTock | 41:8d4609ea7259 | 290 | mWs_x4 += imWs_x4; // total mWs_x4 |
TickTock | 41:8d4609ea7259 | 291 | numWsamples++; |
TickTock | 41:8d4609ea7259 | 292 | } |
garygid | 80:cf009a64eedd | 293 | |
garygid | 80:cf009a64eedd | 294 | //------------------------- |
garygid | 79:24f1793171e7 | 295 | }else if((mType==1)&&(canRXmsg.id==0x1da)){ // EV bus |
garygid | 79:24f1793171e7 | 296 | // Motor Speed |
TickTock | 41:8d4609ea7259 | 297 | imotorRPM=((canRXmsg.data[4]<<8)|(canRXmsg.data[5])); |
TickTock | 51:6187c5264a73 | 298 | if(imotorRPM<0){ // take absolute value |
TickTock | 51:6187c5264a73 | 299 | imotorRPM=-imotorRPM; |
TickTock | 51:6187c5264a73 | 300 | } |
TickTock | 41:8d4609ea7259 | 301 | motorRPM+=imotorRPM; |
TickTock | 41:8d4609ea7259 | 302 | numSsamples++; |
TickTock | 37:fea2c1d52c5f | 303 | } |
TickTock | 13:62e0f7f39ff5 | 304 | } |
TickTock | 13:62e0f7f39ff5 | 305 | |
garygid | 79:24f1793171e7 | 306 | //--------------------------------- |
TickTock | 13:62e0f7f39ff5 | 307 | void logTS () { |
TickTock | 13:62e0f7f39ff5 | 308 | CANMessage tsMsg; |
TickTock | 13:62e0f7f39ff5 | 309 | unsigned long secs = time(NULL); // seconds past 12:00:00 AM 1 Jan 1900 |
garygid | 69:6bfdfc002036 | 310 | // NOTE: In Mbed, I believe that this is seconds past start of 1970, not 1900 |
garygid | 69:6bfdfc002036 | 311 | // but this is good, since seconds past 1970 is what CAN-Do expects. GG - Date Time |
TickTock | 13:62e0f7f39ff5 | 312 | tsMsg.id=0xfff; |
TickTock | 13:62e0f7f39ff5 | 313 | tsMsg.len=0xf; |
garygid | 69:6bfdfc002036 | 314 | tsMsg.data[0]=secs&0xff; |
TickTock | 13:62e0f7f39ff5 | 315 | tsMsg.data[1]=(secs>>8)&0xff; |
TickTock | 13:62e0f7f39ff5 | 316 | tsMsg.data[2]=(secs>>16)&0xff; |
garygid | 69:6bfdfc002036 | 317 | tsMsg.data[3]=(secs>>24)&0xff; |
garygid | 69:6bfdfc002036 | 318 | tsMsg.data[4]=0; // 0xff; gg - Date Time |
garygid | 69:6bfdfc002036 | 319 | tsMsg.data[5]=0; // 0xff; for CAN-Do |
garygid | 69:6bfdfc002036 | 320 | tsMsg.data[6]=0; // 0xff; |
TickTock | 13:62e0f7f39ff5 | 321 | tsMsg.data[7]=0xff; |
garygid | 69:6bfdfc002036 | 322 | logCan(0,tsMsg); // Date-Time |
garygid | 69:6bfdfc002036 | 323 | } |
garygid | 69:6bfdfc002036 | 324 | |
garygid | 79:24f1793171e7 | 325 | //---------------------------------- |
garygid | 79:24f1793171e7 | 326 | // gg - logevent |
garygid | 79:24f1793171e7 | 327 | void logEvent (char * errMsg) { |
garygid | 69:6bfdfc002036 | 328 | // log CAN-Do 8-character Pseudo Message |
garygid | 69:6bfdfc002036 | 329 | CANMessage tsMsg; |
garygid | 69:6bfdfc002036 | 330 | tsMsg.id=0xffe; // pseudo Message to CAN-Do log |
garygid | 69:6bfdfc002036 | 331 | tsMsg.len=0xf; |
garygid | 69:6bfdfc002036 | 332 | int iMsgLen = strlen(errMsg); |
garygid | 69:6bfdfc002036 | 333 | // 8 character message compatible with CAN-Do |
garygid | 69:6bfdfc002036 | 334 | for(int i=0; i<8; i++){ |
garygid | 69:6bfdfc002036 | 335 | tsMsg.data[i]=' '; |
garygid | 69:6bfdfc002036 | 336 | if( i < iMsgLen ) tsMsg.data[i]=errMsg[i]; |
garygid | 69:6bfdfc002036 | 337 | } |
garygid | 69:6bfdfc002036 | 338 | logCan(0,tsMsg); // FFE Comment Message |
TickTock | 13:62e0f7f39ff5 | 339 | } |
TickTock | 13:62e0f7f39ff5 | 340 | |
TickTock | 78:a383971fe02f | 341 | void sendReq() { |
TickTock | 78:a383971fe02f | 342 | static char data[8] = {0x02, 0x21, 0x01, 0xff, 0xff, 0xff, 0xff, 0xff}; |
TickTock | 78:a383971fe02f | 343 | if(reqMsgCnt<99){ |
TickTock | 78:a383971fe02f | 344 | switch (reqMsgCnt){ |
TickTock | 78:a383971fe02f | 345 | case 0: |
TickTock | 78:a383971fe02f | 346 | can1.monitor(false); // set to active mode |
TickTock | 78:a383971fe02f | 347 | can1SleepMode = 0; // enable TX |
TickTock | 78:a383971fe02f | 348 | data[0]=0x02; //change to request frame 1 |
TickTock | 78:a383971fe02f | 349 | data[1]=0x21; |
TickTock | 78:a383971fe02f | 350 | data[2]=0x01; |
TickTock | 78:a383971fe02f | 351 | break; |
TickTock | 78:a383971fe02f | 352 | case 6: // frame 1 has 6 lines |
TickTock | 78:a383971fe02f | 353 | can1.monitor(false); // set to active mode |
TickTock | 78:a383971fe02f | 354 | can1SleepMode = 0; // enable TX |
TickTock | 78:a383971fe02f | 355 | data[0]=0x02; //change to request frame 2 (cp data) |
TickTock | 78:a383971fe02f | 356 | data[1]=0x21; |
TickTock | 78:a383971fe02f | 357 | data[2]=0x02; |
TickTock | 78:a383971fe02f | 358 | break; |
TickTock | 78:a383971fe02f | 359 | case 35: // frame 2 has 29 lines |
TickTock | 78:a383971fe02f | 360 | data[0]=0x02; //change to request frame 3 |
TickTock | 78:a383971fe02f | 361 | data[1]=0x21; |
TickTock | 78:a383971fe02f | 362 | data[2]=0x03; |
TickTock | 78:a383971fe02f | 363 | break; |
TickTock | 78:a383971fe02f | 364 | case 40: // frame 3 has 5 lines |
TickTock | 78:a383971fe02f | 365 | data[0]=0x02; //change to request frame 4 (temperature) |
TickTock | 78:a383971fe02f | 366 | data[1]=0x21; |
TickTock | 78:a383971fe02f | 367 | data[2]=0x04; |
TickTock | 78:a383971fe02f | 368 | break; |
TickTock | 78:a383971fe02f | 369 | case 43: // frame 4 has 3 lines |
TickTock | 78:a383971fe02f | 370 | data[0]=0x02; //change to request frame 5 |
TickTock | 78:a383971fe02f | 371 | data[1]=0x21; |
TickTock | 78:a383971fe02f | 372 | data[2]=0x05; |
TickTock | 78:a383971fe02f | 373 | break; |
TickTock | 78:a383971fe02f | 374 | case 54: // frame 5 has 11 lines |
TickTock | 78:a383971fe02f | 375 | reqMsgCnt = 99; |
TickTock | 78:a383971fe02f | 376 | can1SleepMode = 1; // disable TX |
TickTock | 78:a383971fe02f | 377 | can1.monitor(true); // set to snoop mode |
TickTock | 78:a383971fe02f | 378 | default: |
TickTock | 78:a383971fe02f | 379 | data[0]=0x30; //change to request next line message |
TickTock | 78:a383971fe02f | 380 | data[1]=0x01; |
TickTock | 78:a383971fe02f | 381 | data[2]=0x00; |
TickTock | 78:a383971fe02f | 382 | } |
TickTock | 78:a383971fe02f | 383 | can1.write(CANMessage(0x79b, data, 8)); |
TickTock | 78:a383971fe02f | 384 | reqMsgCnt++; |
TickTock | 78:a383971fe02f | 385 | } |
TickTock | 78:a383971fe02f | 386 | } |
TickTock | 78:a383971fe02f | 387 | |
TickTock | 78:a383971fe02f | 388 | /*void sendCPreq() { |
TickTock | 13:62e0f7f39ff5 | 389 | char i; |
TickTock | 13:62e0f7f39ff5 | 390 | char data[8] = {0x02, 0x21, 0x02, 0xff, 0xff, 0xff, 0xff, 0xff}; |
TickTock | 13:62e0f7f39ff5 | 391 | can1.monitor(false); // set to active mode |
TickTock | 13:62e0f7f39ff5 | 392 | can1SleepMode = 0; // enable TX |
TickTock | 13:62e0f7f39ff5 | 393 | can1.write(CANMessage(0x79b, data, 8)); |
garygid | 69:6bfdfc002036 | 394 | |
garygid | 69:6bfdfc002036 | 395 | if( ZeroSecTick ) { ZeroSecTick = false; logTS(); } // gg - 0-second EV bus |
garygid | 69:6bfdfc002036 | 396 | |
garygid | 69:6bfdfc002036 | 397 | logCan(1,CANMessage(0x79b, data, 8)); // Group 2 Request on EV |
TickTock | 13:62e0f7f39ff5 | 398 | data[0]=0x30; //change to request next line message |
TickTock | 13:62e0f7f39ff5 | 399 | data[1]=0x01; |
TickTock | 13:62e0f7f39ff5 | 400 | data[2]=0x00; |
TickTock | 23:cd03f9c3395e | 401 | for(i=0;i<29;i++){ |
TickTock | 13:62e0f7f39ff5 | 402 | wait_ms(16); //wait 16ms |
TickTock | 13:62e0f7f39ff5 | 403 | can1.write(CANMessage(0x79b, data, 8)); |
TickTock | 13:62e0f7f39ff5 | 404 | } |
TickTock | 13:62e0f7f39ff5 | 405 | can1SleepMode = 1; // disable TX |
TickTock | 13:62e0f7f39ff5 | 406 | can1.monitor(true); // set to snoop mode |
TickTock | 13:62e0f7f39ff5 | 407 | } |
TickTock | 13:62e0f7f39ff5 | 408 | |
TickTock | 13:62e0f7f39ff5 | 409 | void sendTreq() { |
TickTock | 13:62e0f7f39ff5 | 410 | char i; |
TickTock | 13:62e0f7f39ff5 | 411 | char data[8] = {0x02, 0x21, 0x04, 0xff, 0xff, 0xff, 0xff, 0xff}; |
TickTock | 13:62e0f7f39ff5 | 412 | can1.monitor(false); // set to active mode |
TickTock | 13:62e0f7f39ff5 | 413 | can1SleepMode = 0; // enable TX |
TickTock | 13:62e0f7f39ff5 | 414 | can1.write(CANMessage(0x79b, data, 8)); |
garygid | 69:6bfdfc002036 | 415 | |
garygid | 69:6bfdfc002036 | 416 | if( ZeroSecTick ) { ZeroSecTick = false; logTS(); } // gg - 0-second EV bus |
garygid | 69:6bfdfc002036 | 417 | |
garygid | 69:6bfdfc002036 | 418 | logCan(1,CANMessage(0x79b, data, 8)); // Group 4 request on EV |
TickTock | 13:62e0f7f39ff5 | 419 | data[0]=0x30; //change to request next line message |
TickTock | 13:62e0f7f39ff5 | 420 | data[1]=0x01; |
TickTock | 13:62e0f7f39ff5 | 421 | data[2]=0x00; |
TickTock | 23:cd03f9c3395e | 422 | for(i=0;i<3;i++){ |
TickTock | 13:62e0f7f39ff5 | 423 | wait_ms(16); //wait 16ms |
TickTock | 13:62e0f7f39ff5 | 424 | can1.write(CANMessage(0x79b, data, 8)); |
TickTock | 13:62e0f7f39ff5 | 425 | } |
TickTock | 13:62e0f7f39ff5 | 426 | can1SleepMode = 1; // disable TX |
TickTock | 13:62e0f7f39ff5 | 427 | can1.monitor(true); // set to snoop mode |
TickTock | 31:082372c83f68 | 428 | } |
TickTock | 31:082372c83f68 | 429 | |
TickTock | 36:dbd39c315258 | 430 | void autoPollISR() { //This is the ticker ISR for auto-polling |
TickTock | 33:a277743ebdeb | 431 | pollCP=true; //Set a flag to do in main loop instead of here |
TickTock | 78:a383971fe02f | 432 | } //since ticker blocks other interrupts*/ |
TickTock | 13:62e0f7f39ff5 | 433 | |
TickTock | 78:a383971fe02f | 434 | void autoPollISR(){ |
TickTock | 78:a383971fe02f | 435 | reqMsgCnt = 0; //reset message counter |
TickTock | 78:a383971fe02f | 436 | } |
TickTock | 36:dbd39c315258 | 437 | void playbackISR() { //Used for autoplayback |
TickTock | 36:dbd39c315258 | 438 | step=true; |
TickTock | 36:dbd39c315258 | 439 | } |
TickTock | 36:dbd39c315258 | 440 | |
TickTock | 36:dbd39c315258 | 441 | void doNothing(){ //CAN deattach work-around |
TickTock | 36:dbd39c315258 | 442 | } |
TickTock | 36:dbd39c315258 | 443 | |
TickTock | 13:62e0f7f39ff5 | 444 | void recieve1() { |
TickTock | 13:62e0f7f39ff5 | 445 | CANMessage msg1; |
TickTock | 13:62e0f7f39ff5 | 446 | can1.read(msg1); |
garygid | 69:6bfdfc002036 | 447 | |
garygid | 69:6bfdfc002036 | 448 | if( ZeroSecTick ) { ZeroSecTick = false; logTS(); } // gg - 0-second EV bus |
garygid | 69:6bfdfc002036 | 449 | |
garygid | 69:6bfdfc002036 | 450 | logCan(1, msg1); // EVcan Message Received |
TickTock | 13:62e0f7f39ff5 | 451 | led1 = !led1; |
TickTock | 13:62e0f7f39ff5 | 452 | } |
TickTock | 13:62e0f7f39ff5 | 453 | |
TickTock | 13:62e0f7f39ff5 | 454 | void recieve2() { |
TickTock | 13:62e0f7f39ff5 | 455 | CANMessage msg2; |
TickTock | 13:62e0f7f39ff5 | 456 | can2.read(msg2); |
garygid | 69:6bfdfc002036 | 457 | |
garygid | 69:6bfdfc002036 | 458 | if( ZeroSecTick ) { ZeroSecTick = false; logTS(); } // gg - 0-second EV bus |
garygid | 69:6bfdfc002036 | 459 | |
garygid | 69:6bfdfc002036 | 460 | logCan(2, msg2); // CARcan Message Received |
TickTock | 13:62e0f7f39ff5 | 461 | led2 = !led2; |
TickTock | 13:62e0f7f39ff5 | 462 | } |
TickTock | 13:62e0f7f39ff5 | 463 | |
TickTock | 22:a43df3905863 | 464 | unsigned char buttonX(unsigned short X, unsigned char columns) { |
TickTock | 22:a43df3905863 | 465 | unsigned char val = X*columns/320; |
TickTock | 22:a43df3905863 | 466 | return val; |
TickTock | 22:a43df3905863 | 467 | } |
TickTock | 22:a43df3905863 | 468 | |
TickTock | 22:a43df3905863 | 469 | unsigned char buttonY(unsigned short Y, unsigned char rows) { |
TickTock | 22:a43df3905863 | 470 | unsigned short val = Y*rows/240; |
TickTock | 22:a43df3905863 | 471 | return val; |
TickTock | 22:a43df3905863 | 472 | } |
TickTock | 23:cd03f9c3395e | 473 | |
TickTock | 23:cd03f9c3395e | 474 | void saveConfig(){ |
TickTock | 23:cd03f9c3395e | 475 | FILE *cfile; |
TickTock | 23:cd03f9c3395e | 476 | cfile = fopen("/local/config.txt", "w"); |
TickTock | 48:d1ce92104a1f | 477 | fprintf(cfile,"format 3\r\n"); |
TickTock | 23:cd03f9c3395e | 478 | fprintf(cfile,"x0_off %d\r\n",tt.x0_off); |
TickTock | 23:cd03f9c3395e | 479 | fprintf(cfile,"y0_off %d\r\n",tt.y0_off); |
TickTock | 23:cd03f9c3395e | 480 | fprintf(cfile,"x0_pp %d\r\n",tt.x0_pp); |
TickTock | 23:cd03f9c3395e | 481 | fprintf(cfile,"y0_pp %d\r\n",tt.y0_pp); |
TickTock | 23:cd03f9c3395e | 482 | fprintf(cfile,"x1_off %d\r\n",tt.x1_off); |
TickTock | 23:cd03f9c3395e | 483 | fprintf(cfile,"y1_off %d\r\n",tt.y1_off); |
TickTock | 23:cd03f9c3395e | 484 | fprintf(cfile,"x1_pp %d\r\n",tt.x1_pp); |
TickTock | 23:cd03f9c3395e | 485 | fprintf(cfile,"y1_pp %d\r\n",tt.y1_pp); |
TickTock | 23:cd03f9c3395e | 486 | fprintf(cfile,"x_mid %d\r\n",tt.x_mid); |
TickTock | 26:462ccb580472 | 487 | if (dMode[0]==config1Screen) |
TickTock | 41:8d4609ea7259 | 488 | fprintf(cfile,"dMode0 %d\r\n",mainScreen); |
TickTock | 26:462ccb580472 | 489 | else |
TickTock | 26:462ccb580472 | 490 | fprintf(cfile,"dMode0 %d\r\n",dMode[0]); |
TickTock | 26:462ccb580472 | 491 | if (dMode[1]==config1Screen) |
TickTock | 41:8d4609ea7259 | 492 | fprintf(cfile,"dMode1 %d\r\n",mainScreen); |
TickTock | 26:462ccb580472 | 493 | else |
TickTock | 26:462ccb580472 | 494 | fprintf(cfile,"dMode1 %d\r\n",dMode[1]); |
TickTock | 35:5acbd8a64a89 | 495 | fprintf(cfile,"ledHi %4.3f\r\n",ledHi); |
TickTock | 35:5acbd8a64a89 | 496 | fprintf(cfile,"ledLo %4.3f\r\n",ledLo); |
TickTock | 35:5acbd8a64a89 | 497 | fprintf(cfile,"pollInt %d\r\n",pollInt); |
TickTock | 35:5acbd8a64a89 | 498 | fprintf(cfile,"scale12V %4.2f\r\n",scale12V); |
TickTock | 48:d1ce92104a1f | 499 | fprintf(cfile,"skin %d\r\n",skin); |
TickTock | 50:83d5864c64a0 | 500 | fprintf(cfile,"dtePeriod %d\r\n",dtePeriod); |
TickTock | 23:cd03f9c3395e | 501 | fclose(cfile); |
TickTock | 23:cd03f9c3395e | 502 | } |
TickTock | 23:cd03f9c3395e | 503 | |
TickTock | 23:cd03f9c3395e | 504 | void readConfig(){ |
TickTock | 23:cd03f9c3395e | 505 | FILE *cfile; |
TickTock | 23:cd03f9c3395e | 506 | int ff; |
TickTock | 23:cd03f9c3395e | 507 | char sTemp[40]; |
TickTock | 23:cd03f9c3395e | 508 | cfile = fopen("/local/config.txt", "r"); |
TickTock | 23:cd03f9c3395e | 509 | if (cfile==NULL){ // if doesn't exist --> create |
TickTock | 23:cd03f9c3395e | 510 | sprintf(sTemp,"No config file found.\n"); |
garygid | 69:6bfdfc002036 | 511 | logMsg(sTemp); // no config file |
TickTock | 23:cd03f9c3395e | 512 | sprintf(sTemp,"Calibrating touch screen.\n"); |
garygid | 69:6bfdfc002036 | 513 | logMsg(sTemp); // calibrating |
TickTock | 23:cd03f9c3395e | 514 | //tt.setcal(5570, 34030, 80, 108, 33700, 5780, 82, 108, 32500);// bypass calibration using my values |
TickTock | 23:cd03f9c3395e | 515 | tt.calibrate(); // run touchscreen calibration routine |
garygid | 58:4d06288d75a2 | 516 | // NOTE: calibrates screen 1 first, then screen 0. |
TickTock | 23:cd03f9c3395e | 517 | saveConfig(); |
TickTock | 23:cd03f9c3395e | 518 | } else { |
TickTock | 48:d1ce92104a1f | 519 | ledHi = 0.823; |
TickTock | 48:d1ce92104a1f | 520 | ledLo = 0.1; |
TickTock | 48:d1ce92104a1f | 521 | pollInt = 300; |
TickTock | 48:d1ce92104a1f | 522 | scale12V = 16.2; |
TickTock | 48:d1ce92104a1f | 523 | skin = ttSkin; |
TickTock | 48:d1ce92104a1f | 524 | fscanf(cfile, "format %d\r\n", &ff ) ; |
TickTock | 23:cd03f9c3395e | 525 | fscanf(cfile, "x0_off %d\r\n", &tt.x0_off ) ; |
TickTock | 23:cd03f9c3395e | 526 | fscanf(cfile, "y0_off %d\r\n", &tt.y0_off ) ; |
TickTock | 23:cd03f9c3395e | 527 | fscanf(cfile, "x0_pp %d\r\n", &tt.x0_pp ) ; |
TickTock | 23:cd03f9c3395e | 528 | fscanf(cfile, "y0_pp %d\r\n", &tt.y0_pp ) ; |
TickTock | 23:cd03f9c3395e | 529 | fscanf(cfile, "x1_off %d\r\n", &tt.x1_off ) ; |
TickTock | 23:cd03f9c3395e | 530 | fscanf(cfile, "y1_off %d\r\n", &tt.y1_off ) ; |
TickTock | 23:cd03f9c3395e | 531 | fscanf(cfile, "x1_pp %d\r\n", &tt.x1_pp ) ; |
TickTock | 23:cd03f9c3395e | 532 | fscanf(cfile, "y1_pp %d\r\n", &tt.y1_pp ) ; |
TickTock | 23:cd03f9c3395e | 533 | fscanf(cfile, "x_mid %d\r\n", &tt.x_mid ) ; |
TickTock | 26:462ccb580472 | 534 | fscanf(cfile, "dMode0 %d\r\n", &dMode[0] ) ; |
TickTock | 26:462ccb580472 | 535 | fscanf(cfile, "dMode1 %d\r\n", &dMode[1] ) ; |
TickTock | 35:5acbd8a64a89 | 536 | if(ff>1){ |
TickTock | 48:d1ce92104a1f | 537 | fscanf(cfile, "ledHi %f\r\n", &ledHi ) ; |
TickTock | 48:d1ce92104a1f | 538 | fscanf(cfile, "ledLo %f\r\n", &ledLo ) ; |
TickTock | 35:5acbd8a64a89 | 539 | fscanf(cfile, "pollInt %d\r\n", &pollInt ) ; |
TickTock | 48:d1ce92104a1f | 540 | fscanf(cfile, "scale12V %f\r\n", &scale12V ) ; |
TickTock | 48:d1ce92104a1f | 541 | } |
TickTock | 48:d1ce92104a1f | 542 | if(ff>2){ |
TickTock | 48:d1ce92104a1f | 543 | fscanf(cfile, "skin %d\r\n", &skin ) ; |
TickTock | 50:83d5864c64a0 | 544 | fscanf(cfile, "dtePeriod %d\r\n", &dtePeriod ) ; |
TickTock | 35:5acbd8a64a89 | 545 | } |
TickTock | 23:cd03f9c3395e | 546 | fclose(cfile); |
TickTock | 48:d1ce92104a1f | 547 | if(ff<3){//If not latest format, save as latest format |
TickTock | 35:5acbd8a64a89 | 548 | saveConfig(); |
TickTock | 48:d1ce92104a1f | 549 | sprintf(sTemp,"Config file format updated.\n"); |
garygid | 69:6bfdfc002036 | 550 | logMsg(sTemp); // config forat updates |
TickTock | 48:d1ce92104a1f | 551 | } |
TickTock | 43:e7f6f80590e3 | 552 | sprintf(sTemp,"Config file loaded.\n"); |
garygid | 69:6bfdfc002036 | 553 | logMsg(sTemp); // config file loaded |
TickTock | 23:cd03f9c3395e | 554 | } |
TickTock | 23:cd03f9c3395e | 555 | } |
TickTock | 25:ddf0ec209f03 | 556 | |
TickTock | 25:ddf0ec209f03 | 557 | void upDate(unsigned char field, bool upDownBar){ |
TickTock | 25:ddf0ec209f03 | 558 | struct tm t; // pointer to a static tm structure |
TickTock | 25:ddf0ec209f03 | 559 | time_t seconds ; |
TickTock | 25:ddf0ec209f03 | 560 | seconds = time(NULL); |
TickTock | 25:ddf0ec209f03 | 561 | t = *localtime(&seconds) ; |
TickTock | 25:ddf0ec209f03 | 562 | switch(field){ |
TickTock | 25:ddf0ec209f03 | 563 | case 0: // year |
TickTock | 25:ddf0ec209f03 | 564 | if (upDownBar) { |
TickTock | 25:ddf0ec209f03 | 565 | t.tm_year = t.tm_year+1; |
TickTock | 25:ddf0ec209f03 | 566 | } else { |
TickTock | 25:ddf0ec209f03 | 567 | t.tm_year = t.tm_year-1; |
TickTock | 25:ddf0ec209f03 | 568 | } |
TickTock | 25:ddf0ec209f03 | 569 | break; |
TickTock | 25:ddf0ec209f03 | 570 | case 1: // month |
TickTock | 25:ddf0ec209f03 | 571 | if (upDownBar) { |
TickTock | 25:ddf0ec209f03 | 572 | t.tm_mon = (t.tm_mon<12)?t.tm_mon+1:1; |
TickTock | 25:ddf0ec209f03 | 573 | } else { |
TickTock | 25:ddf0ec209f03 | 574 | t.tm_mon = (t.tm_mon>2)?t.tm_mon-1:12; |
TickTock | 25:ddf0ec209f03 | 575 | } |
TickTock | 25:ddf0ec209f03 | 576 | break; |
TickTock | 25:ddf0ec209f03 | 577 | case 2: // day |
TickTock | 25:ddf0ec209f03 | 578 | if (upDownBar) { |
TickTock | 25:ddf0ec209f03 | 579 | t.tm_mday = (t.tm_mday<31)?t.tm_mday+1:1; |
TickTock | 25:ddf0ec209f03 | 580 | } else { |
TickTock | 25:ddf0ec209f03 | 581 | t.tm_mday = (t.tm_mday>2)?t.tm_mday-1:31; |
TickTock | 25:ddf0ec209f03 | 582 | } |
TickTock | 25:ddf0ec209f03 | 583 | break; |
TickTock | 25:ddf0ec209f03 | 584 | case 3: // hour |
TickTock | 25:ddf0ec209f03 | 585 | if (upDownBar) { |
TickTock | 25:ddf0ec209f03 | 586 | t.tm_hour = (t.tm_hour<23)?t.tm_hour+1:0; |
TickTock | 25:ddf0ec209f03 | 587 | } else { |
TickTock | 25:ddf0ec209f03 | 588 | t.tm_hour = (t.tm_hour>1)?t.tm_hour-1:23; |
TickTock | 25:ddf0ec209f03 | 589 | } |
TickTock | 25:ddf0ec209f03 | 590 | break; |
TickTock | 25:ddf0ec209f03 | 591 | case 4: // minute |
TickTock | 25:ddf0ec209f03 | 592 | if (upDownBar) { |
TickTock | 25:ddf0ec209f03 | 593 | t.tm_min = (t.tm_min<59)?t.tm_min+1:0; |
TickTock | 25:ddf0ec209f03 | 594 | } else { |
TickTock | 25:ddf0ec209f03 | 595 | t.tm_min = (t.tm_min>1)?t.tm_min-1:59; |
TickTock | 25:ddf0ec209f03 | 596 | } |
TickTock | 25:ddf0ec209f03 | 597 | break; |
TickTock | 25:ddf0ec209f03 | 598 | case 5: // second |
TickTock | 25:ddf0ec209f03 | 599 | if (upDownBar) { |
TickTock | 25:ddf0ec209f03 | 600 | t.tm_sec = (t.tm_sec<59)?t.tm_sec+1:0; |
TickTock | 25:ddf0ec209f03 | 601 | } else { |
TickTock | 25:ddf0ec209f03 | 602 | t.tm_sec = (t.tm_sec>1)?t.tm_sec-1:59; |
TickTock | 25:ddf0ec209f03 | 603 | } |
TickTock | 25:ddf0ec209f03 | 604 | break; |
TickTock | 25:ddf0ec209f03 | 605 | default: |
TickTock | 25:ddf0ec209f03 | 606 | break; |
TickTock | 25:ddf0ec209f03 | 607 | } |
TickTock | 25:ddf0ec209f03 | 608 | set_time(mktime(&t)); |
TickTock | 25:ddf0ec209f03 | 609 | } |
TickTock | 25:ddf0ec209f03 | 610 | |
TickTock | 39:eef8beac7411 | 611 | void logPackVoltages() { // Turbo3 - routine to dump CP values to text file |
TickTock | 39:eef8beac7411 | 612 | char sTemp[40]; |
TickTock | 39:eef8beac7411 | 613 | struct tm t; // pointer to a static tm structure |
TickTock | 39:eef8beac7411 | 614 | short unsigned max, min, jv, i, bd; |
TickTock | 39:eef8beac7411 | 615 | unsigned avg; |
TickTock | 39:eef8beac7411 | 616 | unsigned short gids, SOC, packV; |
TickTock | 39:eef8beac7411 | 617 | signed short packA; |
TickTock | 39:eef8beac7411 | 618 | time_t seconds ; |
TickTock | 39:eef8beac7411 | 619 | |
TickTock | 39:eef8beac7411 | 620 | CANMessage msg; |
TickTock | 39:eef8beac7411 | 621 | |
TickTock | 39:eef8beac7411 | 622 | seconds = time(NULL); // Turbo3 |
TickTock | 39:eef8beac7411 | 623 | t = *localtime(&seconds) ; // Turbo3 |
TickTock | 39:eef8beac7411 | 624 | |
TickTock | 39:eef8beac7411 | 625 | msg = lastMsg[indexLastMsg[0x5bc]]; //Get gids |
TickTock | 39:eef8beac7411 | 626 | gids = (msg.data[0]<<2)+(msg.data[1]>>6); |
TickTock | 39:eef8beac7411 | 627 | msg = lastMsg[indexLastMsg[0x55b]]; //Get SOC |
TickTock | 39:eef8beac7411 | 628 | SOC = (msg.data[0]<<2)+(msg.data[1]>>6); |
TickTock | 39:eef8beac7411 | 629 | msg = lastMsg[indexLastMsg[0x1db]]; //Get pack volts |
TickTock | 39:eef8beac7411 | 630 | packV = (msg.data[2]<<2)+(msg.data[3]>>6); |
TickTock | 39:eef8beac7411 | 631 | packA = (msg.data[0]<<3)+(msg.data[1]>>5); |
TickTock | 39:eef8beac7411 | 632 | if (packA & 0x400) packA |= 0xf800; |
TickTock | 39:eef8beac7411 | 633 | |
TickTock | 39:eef8beac7411 | 634 | max=0; |
TickTock | 39:eef8beac7411 | 635 | min=9999; |
TickTock | 39:eef8beac7411 | 636 | avg=0; |
TickTock | 39:eef8beac7411 | 637 | for(i=0; i<96; i++) { |
TickTock | 39:eef8beac7411 | 638 | bd=(battData[i*2+3]<<8)+battData[i*2+4]; |
TickTock | 39:eef8beac7411 | 639 | avg+=bd; |
TickTock | 39:eef8beac7411 | 640 | if(bd>max) max=bd; |
TickTock | 39:eef8beac7411 | 641 | if(bd<min) min=bd; |
TickTock | 39:eef8beac7411 | 642 | } |
TickTock | 39:eef8beac7411 | 643 | avg /= 96; |
TickTock | 39:eef8beac7411 | 644 | if(min<3713) { |
TickTock | 39:eef8beac7411 | 645 | jv=avg-(max-avg)*1.5; |
TickTock | 39:eef8beac7411 | 646 | } else { // Only compute judgement value if min cellpair meets <= 3712mV requirement |
TickTock | 39:eef8beac7411 | 647 | jv=0; |
TickTock | 39:eef8beac7411 | 648 | } |
TickTock | 39:eef8beac7411 | 649 | |
TickTock | 39:eef8beac7411 | 650 | FILE *bfile; |
TickTock | 39:eef8beac7411 | 651 | //bfile = fopen("/local/batvolt.txt", "a"); |
TickTock | 39:eef8beac7411 | 652 | bfile = fopen("/usb/batvolt.txt", "a"); |
TickTock | 39:eef8beac7411 | 653 | if(bfile!=NULL) { |
TickTock | 39:eef8beac7411 | 654 | strftime(sTemp, 40, "%a %m/%d/%Y %X", &t); |
TickTock | 39:eef8beac7411 | 655 | fprintf(bfile,"%s,%d,%5.1f%%,%5.1f,%5.1f,%d,%d,%d,%d,%d",sTemp,gids,(float)SOC/10,(float)packV/2,(float)packA/2,max,min,avg,max-min,jv); |
TickTock | 39:eef8beac7411 | 656 | fprintf(bfile,"%d,%d,%d,%d,",(battData[224+ 3]<<8)+battData[224+ 4],battData[224+ 5],(battData[224+ 6]<<8)+battData[224+ 7],battData[224+ 8]); |
TickTock | 39:eef8beac7411 | 657 | fprintf(bfile,"%d,%d,%d,%d", (battData[224+ 9]<<8)+battData[224+10],battData[224+11],(battData[224+12]<<8)+battData[224+13],battData[224+14]); |
TickTock | 39:eef8beac7411 | 658 | for(i=0; i<96; i++) { |
TickTock | 39:eef8beac7411 | 659 | bd=(battData[i*2+3]<<8)+battData[i*2+4]; |
TickTock | 39:eef8beac7411 | 660 | fprintf(bfile,",%d",bd); |
TickTock | 39:eef8beac7411 | 661 | } |
TickTock | 39:eef8beac7411 | 662 | fprintf(bfile,"\r\n"); |
TickTock | 39:eef8beac7411 | 663 | fclose(bfile); |
TickTock | 39:eef8beac7411 | 664 | } |
TickTock | 39:eef8beac7411 | 665 | logCP=false; |
TickTock | 40:0e6e71a7323f | 666 | showCP=true; |
TickTock | 39:eef8beac7411 | 667 | } |
TickTock | 25:ddf0ec209f03 | 668 |