Tick Tock / Mbed 2 deprecated CANary_9341

Dual CANbus monitor and instrumentation cluster supporting ILI9341 display controller

Dependencies:   SPI_TFTx2_ILI9341 TOUCH_TFTx2_ILI9341 TFT_fonts mbed

Fork of CANary by Tick Tock

utility.cpp@81:cf009a64eedd, 2013-04-16 (annotated)

Committer:
garygid
Date:
Tue Apr 16 21:49:13 2013 +0000
Revision:
81:cf009a64eedd
Parent:
80:24f1793171e7
Parent:
78:a383971fe02f
Child:
83:52b1f330a62d
Merge with v78

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 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 80:24f1793171e7 41 //------------------------------------
garygid 80:24f1793171e7 42 // gg - logcan
TickTock 13:62e0f7f39ff5 43 void logCan (char mType, CANMessage canRXmsg) {
garygid 80:24f1793171e7 44 // re-arranged to put static first
garygid 80:24f1793171e7 45 static unsigned char ii = 0;
garygid 80:24f1793171e7 46 static unsigned char lasti = 0; // indexindex
garygid 80:24f1793171e7 47 static unsigned char bdi=0;
garygid 80:24f1793171e7 48 static signed short imotorRPM = 0;
garygid 80:24f1793171e7 49 static unsigned short nLost = 0; // gg - overrun
garygid 80:24f1793171e7 50
garygid 69:6bfdfc002036 51 char sTemp[40];
TickTock 13:62e0f7f39ff5 52 unsigned char changed,i;
garygid 80: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 80:24f1793171e7 58 unsigned short ts = getTimeStamp();
TickTock 36:dbd39c315258 59 secsNoMsg=0; // reset deadman switch
garygid 80:24f1793171e7 60
TickTock 13:62e0f7f39ff5 61 if(logOpen){
TickTock 13:62e0f7f39ff5 62 if(canRXmsg.id>0) {
garygid 80:24f1793171e7 63 // check to see if buffer is already full (read - write) = 1
garygid 80:24f1793171e7 64 // actually the last buffer location cannot be used because then
garygid 80:24f1793171e7 65 // the buffer would look empty after writePointer++
garygid 80:24f1793171e7 66
garygid 80:24f1793171e7 67 //if (((writePointer+maxBufLen-readPointer)%maxBufLen)>(maxBufLen/16)) // modulo is slow?
garygid 80:24f1793171e7 68
garygid 80:24f1793171e7 69 // maxBufLen = 512, so pointers are 0 through 511
garygid 80:24f1793171e7 70 if( (readPointer - writePointer) == 1 || (writePointer - readPointer) == (maxBufLen - 1)) {
garygid 80:24f1793171e7 71 // the buffer is "full", so Lose this message
garygid 80:24f1793171e7 72
garygid 80:24f1793171e7 73 // point to the last-stored message
garygid 80:24f1793171e7 74 int tempWritePointer = writePointer - 1 ;
garygid 80:24f1793171e7 75 if( tempWritePointer == -1 ) tempWritePointer = maxBufLen - 1;
garygid 80:24f1793171e7 76 char strLost[9] ;
garygid 80:24f1793171e7 77
garygid 80:24f1793171e7 78 if( nLost == 0 ) {
garygid 80:24f1793171e7 79 // this is the first message lost
garygid 80:24f1793171e7 80 // and we must overwrite the last message with an FFE comment message
garygid 80:24f1793171e7 81 // So, there will be two messages lost as the comment message is laid in.
garygid 80:24f1793171e7 82 nLost = 2;
garygid 80:24f1793171e7 83 sprintf(strLost,"%s","Lost0002"); // indicate two messages lost
garygid 80:24f1793171e7 84
garygid 80:24f1793171e7 85 // overlay the last message with a "Lost0002" comment
garygid 80:24f1793171e7 86 writeBuffer[tempWritePointer][0]=0;
garygid 80:24f1793171e7 87 writeBuffer[tempWritePointer][1]=(ts&0xff00)>>8; // Time Stamp (2 bytes_
garygid 80:24f1793171e7 88 writeBuffer[tempWritePointer][2]=(ts&0x00ff);
garygid 80:24f1793171e7 89 writeBuffer[tempWritePointer][3]=0xfe; // MsgID, low byte
garygid 80:24f1793171e7 90 writeBuffer[tempWritePointer][4]=0xff; // Len nibble, and MsgID high nibble
garygid 80:24f1793171e7 91
garygid 80:24f1793171e7 92 for(i=5;i<13;i++){
garygid 80:24f1793171e7 93 writeBuffer[tempWritePointer][i]= strLost[i-5];
garygid 80:24f1793171e7 94 }
garygid 80:24f1793171e7 95 } else {
garygid 80:24f1793171e7 96 // increment the loat counter
garygid 80:24f1793171e7 97 nLost += 1;
garygid 80:24f1793171e7 98
garygid 80:24f1793171e7 99 // lay the new count into the comment
garygid 80:24f1793171e7 100 sprintf(strLost,"%04d",nLost);
garygid 80:24f1793171e7 101 for(i=9;i<13;i++){
garygid 80:24f1793171e7 102 writeBuffer[tempWritePointer][i]= strLost[i-9];
garygid 80:24f1793171e7 103 }
garygid 80:24f1793171e7 104 }
garygid 80:24f1793171e7 105 } else {
garygid 80:24f1793171e7 106 // is room to insert the message
garygid 80:24f1793171e7 107 // get it inserted quickly
garygid 80:24f1793171e7 108 writeBuffer[writePointer][0]=mType;
garygid 80:24f1793171e7 109 writeBuffer[writePointer][1]=(ts&0xff00)>>8; // Time Stamp (2 bytes_
garygid 80:24f1793171e7 110 writeBuffer[writePointer][2]=(ts&0x00ff);
garygid 80:24f1793171e7 111 writeBuffer[writePointer][3]=canRXmsg.id&0xff; // MsgID, low byte
garygid 80:24f1793171e7 112 writeBuffer[writePointer][4]=(canRXmsg.id>>8)+(canRXmsg.len<<4); // Len nibble, and MsgID high nibble
garygid 80:24f1793171e7 113 for(i=5;i<13;i++){ // Is there a better way to do this? (writeBuffer[writePointer][i]=canRXmsg.data?)
garygid 80:24f1793171e7 114 writeBuffer[writePointer][i]=canRXmsg.data[i-5];
garygid 80:24f1793171e7 115 }
garygid 80:24f1793171e7 116 //--------------
garygid 80:24f1793171e7 117 // force unused data bytes to FF for CAN-Do compatibility - gg - force FF
garygid 80:24f1793171e7 118 if(canRXmsg.len < 8){
garygid 80:24f1793171e7 119 for(i=canRXmsg.len; i<8; i++) {
garygid 80:24f1793171e7 120 writeBuffer[writePointer][i+5]=0xFF;
garygid 80:24f1793171e7 121 }
garygid 80:24f1793171e7 122 }
garygid 80:24f1793171e7 123 //--------------
garygid 80:24f1793171e7 124 // note, this is not protected from the interrupt
garygid 80:24f1793171e7 125 // due to the nLost code above, this no longer
garygid 80:24f1793171e7 126 // overflows to writePointer = readPointer
garygid 80:24f1793171e7 127 // which would make the buffer look empty
garygid 80:24f1793171e7 128 if (++writePointer >= maxBufLen) {
garygid 80:24f1793171e7 129 writePointer = 0;
garygid 80:24f1793171e7 130 led3 = !led3;
garygid 80:24f1793171e7 131 }
garygid 80:24f1793171e7 132 //--------------
garygid 80:24f1793171e7 133 // log a local message if we had lost messages. gg - logcan
garygid 80:24f1793171e7 134 if( nLost > 0 ) {
garygid 80:24f1793171e7 135 // We previously lost messages that did not get into the buffer
garygid 80:24f1793171e7 136 sprintf(sTemp,"-- Write Buffer Lost [%d]\n", nLost);
garygid 80:24f1793171e7 137 logMsg(sTemp); // write buffer overrun
garygid 80:24f1793171e7 138 spkr.beep(500,0.25);
garygid 80:24f1793171e7 139
garygid 80:24f1793171e7 140 nLost = 0 ;
garygid 80:24f1793171e7 141 }
garygid 80:24f1793171e7 142 //--------------
TickTock 13:62e0f7f39ff5 143 }
TickTock 13:62e0f7f39ff5 144 }
TickTock 37:fea2c1d52c5f 145 }
garygid 80:24f1793171e7 146
garygid 80:24f1793171e7 147 //-------------------------------
garygid 80:24f1793171e7 148 // Some MsgIDS are FFF and FFE, but this array only holds 0 to 7FF
garygid 80:24f1793171e7 149 // so, only remember messages 7FF or less - gg - logging bug
garygid 80:24f1793171e7 150 if( canRXmsg.id < 0x800 ) {
garygid 80:24f1793171e7 151 // message is 7FF or less - gg - logging bug
garygid 80:24f1793171e7 152
garygid 80:24f1793171e7 153 // Check if this MsgID has an associated ii entry
garygid 80:24f1793171e7 154 if(indexLastMsg[canRXmsg.id]==0) {
garygid 80:24f1793171e7 155 // no ii entry associated with this MsgID
garygid 80:24f1793171e7 156
garygid 80:24f1793171e7 157 // BUG: but ii = 0 is a valid entry after this wraps
garygid 80:24f1793171e7 158 //ii=ii<99?ii+1:0;
garygid 80:24f1793171e7 159 //ii=ii<99?ii+1:1; // FIX: reserve ii = 0 as the "invalid, not used, entry
garygid 80:24f1793171e7 160
garygid 80:24f1793171e7 161 if(ii<99) {
garygid 80:24f1793171e7 162 // unused entries are available
garygid 80:24f1793171e7 163 ii += 1; // use next unused entry
garygid 80:24f1793171e7 164
garygid 80:24f1793171e7 165 // sever previous usage, if any
garygid 80:24f1793171e7 166 //if( iiUsedBy[ii] != 0 ) indexLastMsg[iiUsedBy[ii]]=0;
garygid 80:24f1793171e7 167
garygid 80:24f1793171e7 168 // keep track of what MsgID is using this ii entry
garygid 80:24f1793171e7 169 //iiUsedBy[ii]=canRXmsg.id; // future
garygid 80:24f1793171e7 170
garygid 80:24f1793171e7 171 indexLastMsg[canRXmsg.id]=ii; // Create MsgID linkage for first message
garygid 80:24f1793171e7 172
garygid 80:24f1793171e7 173 // update the entry's data
garygid 80:24f1793171e7 174 lastMsg[ii]=canRXmsg; //Store in table
garygid 80:24f1793171e7 175
garygid 80:24f1793171e7 176 changed = 0xff ; // all bytes are new, so all changed
garygid 80:24f1793171e7 177 msgChanged[ii]=changed;
garygid 80:24f1793171e7 178
garygid 80:24f1793171e7 179 } else {
garygid 80:24f1793171e7 180 // no more available unused entries
garygid 80:24f1793171e7 181 // so just ignore this MsgID for now
garygid 80:24f1793171e7 182 // ii = 1; // start to re-use entries
garygid 80:24f1793171e7 183
garygid 80:24f1793171e7 184 // BUG: after this wraps to re-use the ii's, the old MsgID
garygid 80:24f1793171e7 185 // that was using this ii needs to be invalidated
garygid 80:24f1793171e7 186 //indexLastMsg[iiUsedBy[ii]]=0; // invalidate ii entry for old MsgID
garygid 80:24f1793171e7 187 }
TickTock 40:0e6e71a7323f 188
garygid 80:24f1793171e7 189 } else {
garygid 80:24f1793171e7 190 // there was an old entry for this MsgID to compare to for changes
garygid 80:24f1793171e7 191 ij = indexLastMsg[canRXmsg.id] ;
garygid 80:24f1793171e7 192
garygid 80:24f1793171e7 193 // compare the old message with the new one to make the data-changed flags
garygid 80:24f1793171e7 194 // BUG?: why do this only if viewing the changedScreen?
garygid 80:24f1793171e7 195 if(dMode[0]==changedScreen||dMode[1]==changedScreen){
garygid 80:24f1793171e7 196
garygid 80:24f1793171e7 197 changed=msgChanged[ij]; // why get the old changed bits
garygid 80:24f1793171e7 198 // what clears the changed bits, dislaying them on the changedScreen?
garygid 80:24f1793171e7 199
garygid 80:24f1793171e7 200 // compare the 8 old and new data bytes for changes
garygid 80:24f1793171e7 201 for(i=0;i<8;i++){
garygid 80:24f1793171e7 202 if(lastMsg[ij].data[i]!=canRXmsg.data[i]){
garygid 80:24f1793171e7 203 changed |= 1<<i;
garygid 80:24f1793171e7 204 }
garygid 80:24f1793171e7 205 }
garygid 80:24f1793171e7 206 // store the changes
garygid 80:24f1793171e7 207 msgChanged[ij]=changed;
TickTock 13:62e0f7f39ff5 208 }
garygid 80:24f1793171e7 209
garygid 80:24f1793171e7 210 // after the comparison, if any, update the entry's data
garygid 80:24f1793171e7 211 lastMsg[ij]=canRXmsg; // Store in table
TickTock 13:62e0f7f39ff5 212 }
garygid 80:24f1793171e7 213 } // end of is 7FF or less
TickTock 41:8d4609ea7259 214
garygid 80:24f1793171e7 215 //-----------------------
garygid 80:24f1793171e7 216 // Miscellaneous on-receive operations below
garygid 80:24f1793171e7 217 if((mType==2)&&(canRXmsg.id==0x358)){ // CAR bus
garygid 80:24f1793171e7 218 // headlight/turn signal indicator
garygid 80:24f1793171e7 219 headlights = (canRXmsg.data[1]&0x80)?true:false;
TickTock 41:8d4609ea7259 220
garygid 80:24f1793171e7 221 //-----------------
garygid 80:24f1793171e7 222 }else if((mType==1)&&(canRXmsg.id==0x7bb)){ // EV bus
garygid 80:24f1793171e7 223 // is battery-response data? 7bb [0]=SeqNum 1 2 [3]=Group
garygid 80:24f1793171e7 224 // Need to store all responses
garygid 80:24f1793171e7 225
garygid 80:24f1793171e7 226 // the first SeqNum is 10 (less than 20-2F found later)
TickTock 13:62e0f7f39ff5 227 if(canRXmsg.data[0]<0x20){
garygid 80:24f1793171e7 228 // the f1rst response in a series
garygid 80:24f1793171e7 229 if(canRXmsg.data[3]==2){ //cellpair data Group 2
garygid 80:24f1793171e7 230 bdi=0; // initial SeqNum = 10, so index 0
garygid 80: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 80:24f1793171e7 234 }else if(canRXmsg.data[3]==4){ //temperature data Group 4
garygid 80: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 81: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 81:cf009a64eedd 240
TickTock 13:62e0f7f39ff5 241 lasti=0;
TickTock 13:62e0f7f39ff5 242 }
garygid 81:cf009a64eedd 243
TickTock 78:a383971fe02f 244 if(bdi<0xff){
garygid 81:cf009a64eedd 245 // handle just the recognized response
garygid 81:cf009a64eedd 246 i=canRXmsg.data[0]&0x0f; // lower nibble of D0 is index, 0 to F
garygid 81:cf009a64eedd 247 if(lasti>i){ //detect rollover to 20 (index 0) and offset index appropriately
garygid 81:cf009a64eedd 248 bdi=0x10; // adding 10 to the index for CPs
TickTock 78:a383971fe02f 249 }
garygid 81:cf009a64eedd 250 lasti=i; //remember the index nibble to detect rollover next time around
garygid 81:cf009a64eedd 251 i+=bdi; // 0 to F then 10 through about 1C for CPs
garygid 81:cf009a64eedd 252 // 20 through 22 for the Temperatures (Group 4)
garygid 80:24f1793171e7 253
garygid 81:cf009a64eedd 254 //--------------
garygid 81: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 81: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 80:24f1793171e7 263
garygid 81: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 81:cf009a64eedd 267 // for CP data the base is 0, at i is (i*7)+6 and the last is 28*7+6
garygid 81: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 80:24f1793171e7 278
garygid 80:24f1793171e7 279 //----------------------
garygid 80:24f1793171e7 280 }else if((mType==1)&&(canRXmsg.id==0x1db)){ // EV bus
garygid 80: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 81:cf009a64eedd 293
garygid 81:cf009a64eedd 294 //-------------------------
garygid 80:24f1793171e7 295 }else if((mType==1)&&(canRXmsg.id==0x1da)){ // EV bus
garygid 80: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 80: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 80:24f1793171e7 325 //----------------------------------
garygid 80:24f1793171e7 326 // gg - logevent
garygid 80: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