Dual CANbus monitor and instrumentation cluster supporting ILI9341 display controller
Dependencies: SPI_TFTx2_ILI9341 TOUCH_TFTx2_ILI9341 TFT_fonts mbed
Fork of CANary by
utility.cpp@80:24f1793171e7, 2013-04-16 (annotated)
- Committer:
- garygid
- Date:
- Tue Apr 16 21:13:59 2013 +0000
- Revision:
- 80:24f1793171e7
- Parent:
- 77:7c136766466c
- Child:
- 81:cf009a64eedd
logCan counts overflow Lost Messages, and others
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 | 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 | 80:24f1793171e7 | 238 | }else bdi=0; // strange, BUG? the same as Group 2 |
garygid | 80:24f1793171e7 | 239 | |
TickTock | 13:62e0f7f39ff5 | 240 | lasti=0; |
TickTock | 13:62e0f7f39ff5 | 241 | } |
garygid | 80:24f1793171e7 | 242 | // handle this response |
garygid | 80:24f1793171e7 | 243 | i=canRXmsg.data[0]&0x0f; // lower nibble of D0 is index, 0 to F |
garygid | 80:24f1793171e7 | 244 | if(lasti>i){ //detect rollover to 20 (index 0) and offset index appropriately |
garygid | 80:24f1793171e7 | 245 | bdi=0x10; // adding 10 to the index for CPs |
TickTock | 13:62e0f7f39ff5 | 246 | } |
garygid | 80:24f1793171e7 | 247 | lasti=i; //remember the index nibble to detect rollover next time around |
garygid | 80:24f1793171e7 | 248 | i+=bdi; // 0 to F then 10 through about 1C for CPs |
garygid | 80:24f1793171e7 | 249 | // 20 through 22 for the Temperatures (Group 4) |
garygid | 80:24f1793171e7 | 250 | |
garygid | 80:24f1793171e7 | 251 | //-------------- |
garygid | 80:24f1793171e7 | 252 | // detect last response from the Temperature series. |
TickTock | 48:d1ce92104a1f | 253 | //if(i==22) logCP=true; //Turbo3 |
TickTock | 50:83d5864c64a0 | 254 | //if( (i==22) && (yesBattLog) ) logCP=true; // only if enabled gg - Batt Log |
TickTock | 50:83d5864c64a0 | 255 | if(i==22){ |
garygid | 80:24f1793171e7 | 256 | // is the last response from Temperatures |
garygid | 69:6bfdfc002036 | 257 | logCP=yesBattLog; // Only log if logging enabled |
TickTock | 50:83d5864c64a0 | 258 | showCP=true; // Always show |
TickTock | 50:83d5864c64a0 | 259 | } |
garygid | 80:24f1793171e7 | 260 | |
garygid | 80:24f1793171e7 | 261 | // storing 7 bytes of data from each response (after the SeqNum) |
TickTock | 13:62e0f7f39ff5 | 262 | i*=7; |
TickTock | 40:0e6e71a7323f | 263 | if(i<0xfa){ // Is there a better way to do this? |
garygid | 80:24f1793171e7 | 264 | // for CP data the base is 0, at i is (i*7)+6 and the last is 28*7+6 |
garygid | 80:24f1793171e7 | 265 | // for Temp data, base is 32*7, at i is (i*7)+6 and the last is 34*7+6 |
TickTock | 13:62e0f7f39ff5 | 266 | battData[i+0]=canRXmsg.data[1]; |
TickTock | 13:62e0f7f39ff5 | 267 | battData[i+1]=canRXmsg.data[2]; |
TickTock | 13:62e0f7f39ff5 | 268 | battData[i+2]=canRXmsg.data[3]; |
TickTock | 13:62e0f7f39ff5 | 269 | battData[i+3]=canRXmsg.data[4]; |
TickTock | 13:62e0f7f39ff5 | 270 | battData[i+4]=canRXmsg.data[5]; |
TickTock | 13:62e0f7f39ff5 | 271 | battData[i+5]=canRXmsg.data[6]; |
TickTock | 13:62e0f7f39ff5 | 272 | battData[i+6]=canRXmsg.data[7]; |
TickTock | 13:62e0f7f39ff5 | 273 | } |
garygid | 80:24f1793171e7 | 274 | |
garygid | 80:24f1793171e7 | 275 | //---------------------- |
garygid | 80:24f1793171e7 | 276 | }else if((mType==1)&&(canRXmsg.id==0x1db)){ // EV bus |
garygid | 80:24f1793171e7 | 277 | // Battery Volts and Amps |
garygid | 80:24f1793171e7 | 278 | packV=((canRXmsg.data[2]<<2)|(canRXmsg.data[3]>>6)); // 1 LSB = 0.5V |
garygid | 80:24f1793171e7 | 279 | packA=((canRXmsg.data[0]<<3)|(canRXmsg.data[1]>>5)); // 1 LSB = 0.5A |
garygid | 80:24f1793171e7 | 280 | if(packA>0x03ff){ |
garygid | 80:24f1793171e7 | 281 | packA|=0xf800;//extend sign; |
garygid | 80:24f1793171e7 | 282 | } |
garygid | 80:24f1793171e7 | 283 | imWs_x4 = packV; // Volts*milliSeconds*2 |
garygid | 80:24f1793171e7 | 284 | imWs_x4 *= -packA; // milliWattseconds*4 |
garygid | 80:24f1793171e7 | 285 | if (!((imotorRPM<2)&&(imWs_x4<0))){ //Ignore if charging from wall |
garygid | 80:24f1793171e7 | 286 | mWs_x4 += imWs_x4; // total mWs_x4 |
garygid | 80:24f1793171e7 | 287 | numWsamples++; |
garygid | 80:24f1793171e7 | 288 | } |
garygid | 80:24f1793171e7 | 289 | //------------------------- |
garygid | 80:24f1793171e7 | 290 | #if 0 |
garygid | 80:24f1793171e7 | 291 | }else if((mType==1)&&(canRXmsg.id==0x1db)){ //Battery Volts and Amps |
TickTock | 37:fea2c1d52c5f | 292 | packV=((canRXmsg.data[2]<<2)|(canRXmsg.data[3]>>6)); // 1 LSB = 0.5V |
TickTock | 37:fea2c1d52c5f | 293 | packA=((canRXmsg.data[0]<<3)|(canRXmsg.data[1]>>5)); // 1 LSB = 0.5A |
TickTock | 37:fea2c1d52c5f | 294 | if(packA>0x03ff){ |
TickTock | 37:fea2c1d52c5f | 295 | packA|=0xf800;//extend sign; |
TickTock | 37:fea2c1d52c5f | 296 | } |
TickTock | 40:0e6e71a7323f | 297 | imWs_x4 = packV; // Volts*milliSeconds*2 |
TickTock | 40:0e6e71a7323f | 298 | imWs_x4 *= -packA; // milliWattseconds*4 |
TickTock | 41:8d4609ea7259 | 299 | if (!((imotorRPM<2)&&(imWs_x4<0))){ //Ignore if charging from wall |
TickTock | 41:8d4609ea7259 | 300 | mWs_x4 += imWs_x4; // total mWs_x4 |
TickTock | 41:8d4609ea7259 | 301 | numWsamples++; |
TickTock | 41:8d4609ea7259 | 302 | } |
TickTock | 41:8d4609ea7259 | 303 | }else if((mType==1)&&(canRXmsg.id==0x1da)){ //Motor Speed |
TickTock | 41:8d4609ea7259 | 304 | imotorRPM=((canRXmsg.data[4]<<8)|(canRXmsg.data[5])); |
TickTock | 51:6187c5264a73 | 305 | if(imotorRPM<0){ // take absolute value |
TickTock | 51:6187c5264a73 | 306 | imotorRPM=-imotorRPM; |
TickTock | 51:6187c5264a73 | 307 | } |
TickTock | 41:8d4609ea7259 | 308 | motorRPM+=imotorRPM; |
TickTock | 41:8d4609ea7259 | 309 | numSsamples++; |
TickTock | 37:fea2c1d52c5f | 310 | } |
garygid | 80:24f1793171e7 | 311 | #endif |
garygid | 80:24f1793171e7 | 312 | //------------------------- |
garygid | 80:24f1793171e7 | 313 | }else if((mType==1)&&(canRXmsg.id==0x1da)){ // EV bus |
garygid | 80:24f1793171e7 | 314 | // Motor Speed |
garygid | 80:24f1793171e7 | 315 | imotorRPM=((canRXmsg.data[4]<<8)|(canRXmsg.data[5])); |
garygid | 80:24f1793171e7 | 316 | if(imotorRPM<0){ // take absolute value |
garygid | 80:24f1793171e7 | 317 | imotorRPM=-imotorRPM; |
garygid | 80:24f1793171e7 | 318 | } |
garygid | 80:24f1793171e7 | 319 | motorRPM+=imotorRPM; |
garygid | 80:24f1793171e7 | 320 | numSsamples++; |
garygid | 80:24f1793171e7 | 321 | } |
TickTock | 13:62e0f7f39ff5 | 322 | } |
TickTock | 13:62e0f7f39ff5 | 323 | |
garygid | 80:24f1793171e7 | 324 | //--------------------------------- |
TickTock | 13:62e0f7f39ff5 | 325 | void logTS () { |
TickTock | 13:62e0f7f39ff5 | 326 | CANMessage tsMsg; |
TickTock | 13:62e0f7f39ff5 | 327 | unsigned long secs = time(NULL); // seconds past 12:00:00 AM 1 Jan 1900 |
garygid | 69:6bfdfc002036 | 328 | // NOTE: In Mbed, I believe that this is seconds past start of 1970, not 1900 |
garygid | 69:6bfdfc002036 | 329 | // but this is good, since seconds past 1970 is what CAN-Do expects. GG - Date Time |
TickTock | 13:62e0f7f39ff5 | 330 | tsMsg.id=0xfff; |
TickTock | 13:62e0f7f39ff5 | 331 | tsMsg.len=0xf; |
garygid | 69:6bfdfc002036 | 332 | tsMsg.data[0]=secs&0xff; |
TickTock | 13:62e0f7f39ff5 | 333 | tsMsg.data[1]=(secs>>8)&0xff; |
TickTock | 13:62e0f7f39ff5 | 334 | tsMsg.data[2]=(secs>>16)&0xff; |
garygid | 69:6bfdfc002036 | 335 | tsMsg.data[3]=(secs>>24)&0xff; |
garygid | 69:6bfdfc002036 | 336 | tsMsg.data[4]=0; // 0xff; gg - Date Time |
garygid | 69:6bfdfc002036 | 337 | tsMsg.data[5]=0; // 0xff; for CAN-Do |
garygid | 69:6bfdfc002036 | 338 | tsMsg.data[6]=0; // 0xff; |
TickTock | 13:62e0f7f39ff5 | 339 | tsMsg.data[7]=0xff; |
garygid | 69:6bfdfc002036 | 340 | logCan(0,tsMsg); // Date-Time |
garygid | 69:6bfdfc002036 | 341 | } |
garygid | 69:6bfdfc002036 | 342 | |
garygid | 80:24f1793171e7 | 343 | //---------------------------------- |
garygid | 80:24f1793171e7 | 344 | // gg - logevent |
garygid | 80:24f1793171e7 | 345 | void logEvent (char * errMsg) { |
garygid | 69:6bfdfc002036 | 346 | // log CAN-Do 8-character Pseudo Message |
garygid | 69:6bfdfc002036 | 347 | CANMessage tsMsg; |
garygid | 69:6bfdfc002036 | 348 | tsMsg.id=0xffe; // pseudo Message to CAN-Do log |
garygid | 69:6bfdfc002036 | 349 | tsMsg.len=0xf; |
garygid | 69:6bfdfc002036 | 350 | int iMsgLen = strlen(errMsg); |
garygid | 69:6bfdfc002036 | 351 | // 8 character message compatible with CAN-Do |
garygid | 69:6bfdfc002036 | 352 | for(int i=0; i<8; i++){ |
garygid | 69:6bfdfc002036 | 353 | tsMsg.data[i]=' '; |
garygid | 69:6bfdfc002036 | 354 | if( i < iMsgLen ) tsMsg.data[i]=errMsg[i]; |
garygid | 69:6bfdfc002036 | 355 | } |
garygid | 69:6bfdfc002036 | 356 | logCan(0,tsMsg); // FFE Comment Message |
TickTock | 13:62e0f7f39ff5 | 357 | } |
TickTock | 13:62e0f7f39ff5 | 358 | |
TickTock | 33:a277743ebdeb | 359 | void sendCPreq() { |
TickTock | 13:62e0f7f39ff5 | 360 | char i; |
TickTock | 13:62e0f7f39ff5 | 361 | char data[8] = {0x02, 0x21, 0x02, 0xff, 0xff, 0xff, 0xff, 0xff}; |
TickTock | 13:62e0f7f39ff5 | 362 | can1.monitor(false); // set to active mode |
TickTock | 13:62e0f7f39ff5 | 363 | can1SleepMode = 0; // enable TX |
TickTock | 13:62e0f7f39ff5 | 364 | can1.write(CANMessage(0x79b, data, 8)); |
garygid | 69:6bfdfc002036 | 365 | |
garygid | 69:6bfdfc002036 | 366 | if( ZeroSecTick ) { ZeroSecTick = false; logTS(); } // gg - 0-second EV bus |
garygid | 69:6bfdfc002036 | 367 | |
garygid | 69:6bfdfc002036 | 368 | logCan(1,CANMessage(0x79b, data, 8)); // Group 2 Request on EV |
TickTock | 13:62e0f7f39ff5 | 369 | data[0]=0x30; //change to request next line message |
TickTock | 13:62e0f7f39ff5 | 370 | data[1]=0x01; |
TickTock | 13:62e0f7f39ff5 | 371 | data[2]=0x00; |
TickTock | 23:cd03f9c3395e | 372 | for(i=0;i<29;i++){ |
TickTock | 13:62e0f7f39ff5 | 373 | wait_ms(16); //wait 16ms |
TickTock | 13:62e0f7f39ff5 | 374 | can1.write(CANMessage(0x79b, data, 8)); |
TickTock | 13:62e0f7f39ff5 | 375 | } |
TickTock | 13:62e0f7f39ff5 | 376 | can1SleepMode = 1; // disable TX |
TickTock | 13:62e0f7f39ff5 | 377 | can1.monitor(true); // set to snoop mode |
TickTock | 13:62e0f7f39ff5 | 378 | } |
TickTock | 13:62e0f7f39ff5 | 379 | |
TickTock | 13:62e0f7f39ff5 | 380 | void sendTreq() { |
TickTock | 13:62e0f7f39ff5 | 381 | char i; |
TickTock | 13:62e0f7f39ff5 | 382 | char data[8] = {0x02, 0x21, 0x04, 0xff, 0xff, 0xff, 0xff, 0xff}; |
TickTock | 13:62e0f7f39ff5 | 383 | can1.monitor(false); // set to active mode |
TickTock | 13:62e0f7f39ff5 | 384 | can1SleepMode = 0; // enable TX |
TickTock | 13:62e0f7f39ff5 | 385 | can1.write(CANMessage(0x79b, data, 8)); |
garygid | 69:6bfdfc002036 | 386 | |
garygid | 69:6bfdfc002036 | 387 | if( ZeroSecTick ) { ZeroSecTick = false; logTS(); } // gg - 0-second EV bus |
garygid | 69:6bfdfc002036 | 388 | |
garygid | 69:6bfdfc002036 | 389 | logCan(1,CANMessage(0x79b, data, 8)); // Group 4 request on EV |
TickTock | 13:62e0f7f39ff5 | 390 | data[0]=0x30; //change to request next line message |
TickTock | 13:62e0f7f39ff5 | 391 | data[1]=0x01; |
TickTock | 13:62e0f7f39ff5 | 392 | data[2]=0x00; |
TickTock | 23:cd03f9c3395e | 393 | for(i=0;i<3;i++){ |
TickTock | 13:62e0f7f39ff5 | 394 | wait_ms(16); //wait 16ms |
TickTock | 13:62e0f7f39ff5 | 395 | can1.write(CANMessage(0x79b, data, 8)); |
TickTock | 13:62e0f7f39ff5 | 396 | } |
TickTock | 13:62e0f7f39ff5 | 397 | can1SleepMode = 1; // disable TX |
TickTock | 13:62e0f7f39ff5 | 398 | can1.monitor(true); // set to snoop mode |
TickTock | 31:082372c83f68 | 399 | } |
TickTock | 31:082372c83f68 | 400 | |
TickTock | 36:dbd39c315258 | 401 | void autoPollISR() { //This is the ticker ISR for auto-polling |
TickTock | 33:a277743ebdeb | 402 | pollCP=true; //Set a flag to do in main loop instead of here |
TickTock | 33:a277743ebdeb | 403 | } //since ticker blocks other interrupts |
TickTock | 13:62e0f7f39ff5 | 404 | |
TickTock | 36:dbd39c315258 | 405 | void playbackISR() { //Used for autoplayback |
TickTock | 36:dbd39c315258 | 406 | step=true; |
TickTock | 36:dbd39c315258 | 407 | } |
TickTock | 36:dbd39c315258 | 408 | |
TickTock | 36:dbd39c315258 | 409 | void doNothing(){ //CAN deattach work-around |
TickTock | 36:dbd39c315258 | 410 | } |
TickTock | 36:dbd39c315258 | 411 | |
TickTock | 13:62e0f7f39ff5 | 412 | void recieve1() { |
TickTock | 13:62e0f7f39ff5 | 413 | CANMessage msg1; |
TickTock | 13:62e0f7f39ff5 | 414 | can1.read(msg1); |
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, msg1); // EVcan Message Received |
TickTock | 13:62e0f7f39ff5 | 419 | led1 = !led1; |
TickTock | 13:62e0f7f39ff5 | 420 | } |
TickTock | 13:62e0f7f39ff5 | 421 | |
TickTock | 13:62e0f7f39ff5 | 422 | void recieve2() { |
TickTock | 13:62e0f7f39ff5 | 423 | CANMessage msg2; |
TickTock | 13:62e0f7f39ff5 | 424 | can2.read(msg2); |
garygid | 69:6bfdfc002036 | 425 | |
garygid | 69:6bfdfc002036 | 426 | if( ZeroSecTick ) { ZeroSecTick = false; logTS(); } // gg - 0-second EV bus |
garygid | 69:6bfdfc002036 | 427 | |
garygid | 69:6bfdfc002036 | 428 | logCan(2, msg2); // CARcan Message Received |
TickTock | 13:62e0f7f39ff5 | 429 | led2 = !led2; |
TickTock | 13:62e0f7f39ff5 | 430 | } |
TickTock | 13:62e0f7f39ff5 | 431 | |
TickTock | 22:a43df3905863 | 432 | unsigned char buttonX(unsigned short X, unsigned char columns) { |
TickTock | 22:a43df3905863 | 433 | unsigned char val = X*columns/320; |
TickTock | 22:a43df3905863 | 434 | return val; |
TickTock | 22:a43df3905863 | 435 | } |
TickTock | 22:a43df3905863 | 436 | |
TickTock | 22:a43df3905863 | 437 | unsigned char buttonY(unsigned short Y, unsigned char rows) { |
TickTock | 22:a43df3905863 | 438 | unsigned short val = Y*rows/240; |
TickTock | 22:a43df3905863 | 439 | return val; |
TickTock | 22:a43df3905863 | 440 | } |
TickTock | 23:cd03f9c3395e | 441 | |
TickTock | 23:cd03f9c3395e | 442 | void saveConfig(){ |
TickTock | 23:cd03f9c3395e | 443 | FILE *cfile; |
TickTock | 23:cd03f9c3395e | 444 | cfile = fopen("/local/config.txt", "w"); |
TickTock | 48:d1ce92104a1f | 445 | fprintf(cfile,"format 3\r\n"); |
TickTock | 23:cd03f9c3395e | 446 | fprintf(cfile,"x0_off %d\r\n",tt.x0_off); |
TickTock | 23:cd03f9c3395e | 447 | fprintf(cfile,"y0_off %d\r\n",tt.y0_off); |
TickTock | 23:cd03f9c3395e | 448 | fprintf(cfile,"x0_pp %d\r\n",tt.x0_pp); |
TickTock | 23:cd03f9c3395e | 449 | fprintf(cfile,"y0_pp %d\r\n",tt.y0_pp); |
TickTock | 23:cd03f9c3395e | 450 | fprintf(cfile,"x1_off %d\r\n",tt.x1_off); |
TickTock | 23:cd03f9c3395e | 451 | fprintf(cfile,"y1_off %d\r\n",tt.y1_off); |
TickTock | 23:cd03f9c3395e | 452 | fprintf(cfile,"x1_pp %d\r\n",tt.x1_pp); |
TickTock | 23:cd03f9c3395e | 453 | fprintf(cfile,"y1_pp %d\r\n",tt.y1_pp); |
TickTock | 23:cd03f9c3395e | 454 | fprintf(cfile,"x_mid %d\r\n",tt.x_mid); |
TickTock | 26:462ccb580472 | 455 | if (dMode[0]==config1Screen) |
TickTock | 41:8d4609ea7259 | 456 | fprintf(cfile,"dMode0 %d\r\n",mainScreen); |
TickTock | 26:462ccb580472 | 457 | else |
TickTock | 26:462ccb580472 | 458 | fprintf(cfile,"dMode0 %d\r\n",dMode[0]); |
TickTock | 26:462ccb580472 | 459 | if (dMode[1]==config1Screen) |
TickTock | 41:8d4609ea7259 | 460 | fprintf(cfile,"dMode1 %d\r\n",mainScreen); |
TickTock | 26:462ccb580472 | 461 | else |
TickTock | 26:462ccb580472 | 462 | fprintf(cfile,"dMode1 %d\r\n",dMode[1]); |
TickTock | 35:5acbd8a64a89 | 463 | fprintf(cfile,"ledHi %4.3f\r\n",ledHi); |
TickTock | 35:5acbd8a64a89 | 464 | fprintf(cfile,"ledLo %4.3f\r\n",ledLo); |
TickTock | 35:5acbd8a64a89 | 465 | fprintf(cfile,"pollInt %d\r\n",pollInt); |
TickTock | 35:5acbd8a64a89 | 466 | fprintf(cfile,"scale12V %4.2f\r\n",scale12V); |
TickTock | 48:d1ce92104a1f | 467 | fprintf(cfile,"skin %d\r\n",skin); |
TickTock | 50:83d5864c64a0 | 468 | fprintf(cfile,"dtePeriod %d\r\n",dtePeriod); |
TickTock | 23:cd03f9c3395e | 469 | fclose(cfile); |
TickTock | 23:cd03f9c3395e | 470 | } |
TickTock | 23:cd03f9c3395e | 471 | |
TickTock | 23:cd03f9c3395e | 472 | void readConfig(){ |
TickTock | 23:cd03f9c3395e | 473 | FILE *cfile; |
TickTock | 23:cd03f9c3395e | 474 | int ff; |
TickTock | 23:cd03f9c3395e | 475 | char sTemp[40]; |
TickTock | 23:cd03f9c3395e | 476 | cfile = fopen("/local/config.txt", "r"); |
TickTock | 23:cd03f9c3395e | 477 | if (cfile==NULL){ // if doesn't exist --> create |
TickTock | 23:cd03f9c3395e | 478 | sprintf(sTemp,"No config file found.\n"); |
garygid | 69:6bfdfc002036 | 479 | logMsg(sTemp); // no config file |
TickTock | 23:cd03f9c3395e | 480 | sprintf(sTemp,"Calibrating touch screen.\n"); |
garygid | 69:6bfdfc002036 | 481 | logMsg(sTemp); // calibrating |
TickTock | 23:cd03f9c3395e | 482 | //tt.setcal(5570, 34030, 80, 108, 33700, 5780, 82, 108, 32500);// bypass calibration using my values |
TickTock | 23:cd03f9c3395e | 483 | tt.calibrate(); // run touchscreen calibration routine |
garygid | 58:4d06288d75a2 | 484 | // NOTE: calibrates screen 1 first, then screen 0. |
TickTock | 23:cd03f9c3395e | 485 | saveConfig(); |
TickTock | 23:cd03f9c3395e | 486 | } else { |
TickTock | 48:d1ce92104a1f | 487 | ledHi = 0.823; |
TickTock | 48:d1ce92104a1f | 488 | ledLo = 0.1; |
TickTock | 48:d1ce92104a1f | 489 | pollInt = 300; |
TickTock | 48:d1ce92104a1f | 490 | scale12V = 16.2; |
TickTock | 48:d1ce92104a1f | 491 | skin = ttSkin; |
TickTock | 48:d1ce92104a1f | 492 | fscanf(cfile, "format %d\r\n", &ff ) ; |
TickTock | 23:cd03f9c3395e | 493 | fscanf(cfile, "x0_off %d\r\n", &tt.x0_off ) ; |
TickTock | 23:cd03f9c3395e | 494 | fscanf(cfile, "y0_off %d\r\n", &tt.y0_off ) ; |
TickTock | 23:cd03f9c3395e | 495 | fscanf(cfile, "x0_pp %d\r\n", &tt.x0_pp ) ; |
TickTock | 23:cd03f9c3395e | 496 | fscanf(cfile, "y0_pp %d\r\n", &tt.y0_pp ) ; |
TickTock | 23:cd03f9c3395e | 497 | fscanf(cfile, "x1_off %d\r\n", &tt.x1_off ) ; |
TickTock | 23:cd03f9c3395e | 498 | fscanf(cfile, "y1_off %d\r\n", &tt.y1_off ) ; |
TickTock | 23:cd03f9c3395e | 499 | fscanf(cfile, "x1_pp %d\r\n", &tt.x1_pp ) ; |
TickTock | 23:cd03f9c3395e | 500 | fscanf(cfile, "y1_pp %d\r\n", &tt.y1_pp ) ; |
TickTock | 23:cd03f9c3395e | 501 | fscanf(cfile, "x_mid %d\r\n", &tt.x_mid ) ; |
TickTock | 26:462ccb580472 | 502 | fscanf(cfile, "dMode0 %d\r\n", &dMode[0] ) ; |
TickTock | 26:462ccb580472 | 503 | fscanf(cfile, "dMode1 %d\r\n", &dMode[1] ) ; |
TickTock | 35:5acbd8a64a89 | 504 | if(ff>1){ |
TickTock | 48:d1ce92104a1f | 505 | fscanf(cfile, "ledHi %f\r\n", &ledHi ) ; |
TickTock | 48:d1ce92104a1f | 506 | fscanf(cfile, "ledLo %f\r\n", &ledLo ) ; |
TickTock | 35:5acbd8a64a89 | 507 | fscanf(cfile, "pollInt %d\r\n", &pollInt ) ; |
TickTock | 48:d1ce92104a1f | 508 | fscanf(cfile, "scale12V %f\r\n", &scale12V ) ; |
TickTock | 48:d1ce92104a1f | 509 | } |
TickTock | 48:d1ce92104a1f | 510 | if(ff>2){ |
TickTock | 48:d1ce92104a1f | 511 | fscanf(cfile, "skin %d\r\n", &skin ) ; |
TickTock | 50:83d5864c64a0 | 512 | fscanf(cfile, "dtePeriod %d\r\n", &dtePeriod ) ; |
TickTock | 35:5acbd8a64a89 | 513 | } |
TickTock | 23:cd03f9c3395e | 514 | fclose(cfile); |
TickTock | 48:d1ce92104a1f | 515 | if(ff<3){//If not latest format, save as latest format |
TickTock | 35:5acbd8a64a89 | 516 | saveConfig(); |
TickTock | 48:d1ce92104a1f | 517 | sprintf(sTemp,"Config file format updated.\n"); |
garygid | 69:6bfdfc002036 | 518 | logMsg(sTemp); // config forat updates |
TickTock | 48:d1ce92104a1f | 519 | } |
TickTock | 43:e7f6f80590e3 | 520 | sprintf(sTemp,"Config file loaded.\n"); |
garygid | 69:6bfdfc002036 | 521 | logMsg(sTemp); // config file loaded |
TickTock | 23:cd03f9c3395e | 522 | } |
TickTock | 23:cd03f9c3395e | 523 | } |
TickTock | 25:ddf0ec209f03 | 524 | |
TickTock | 25:ddf0ec209f03 | 525 | void upDate(unsigned char field, bool upDownBar){ |
TickTock | 25:ddf0ec209f03 | 526 | struct tm t; // pointer to a static tm structure |
TickTock | 25:ddf0ec209f03 | 527 | time_t seconds ; |
TickTock | 25:ddf0ec209f03 | 528 | seconds = time(NULL); |
TickTock | 25:ddf0ec209f03 | 529 | t = *localtime(&seconds) ; |
TickTock | 25:ddf0ec209f03 | 530 | switch(field){ |
TickTock | 25:ddf0ec209f03 | 531 | case 0: // year |
TickTock | 25:ddf0ec209f03 | 532 | if (upDownBar) { |
TickTock | 25:ddf0ec209f03 | 533 | t.tm_year = t.tm_year+1; |
TickTock | 25:ddf0ec209f03 | 534 | } else { |
TickTock | 25:ddf0ec209f03 | 535 | t.tm_year = t.tm_year-1; |
TickTock | 25:ddf0ec209f03 | 536 | } |
TickTock | 25:ddf0ec209f03 | 537 | break; |
TickTock | 25:ddf0ec209f03 | 538 | case 1: // month |
TickTock | 25:ddf0ec209f03 | 539 | if (upDownBar) { |
TickTock | 25:ddf0ec209f03 | 540 | t.tm_mon = (t.tm_mon<12)?t.tm_mon+1:1; |
TickTock | 25:ddf0ec209f03 | 541 | } else { |
TickTock | 25:ddf0ec209f03 | 542 | t.tm_mon = (t.tm_mon>2)?t.tm_mon-1:12; |
TickTock | 25:ddf0ec209f03 | 543 | } |
TickTock | 25:ddf0ec209f03 | 544 | break; |
TickTock | 25:ddf0ec209f03 | 545 | case 2: // day |
TickTock | 25:ddf0ec209f03 | 546 | if (upDownBar) { |
TickTock | 25:ddf0ec209f03 | 547 | t.tm_mday = (t.tm_mday<31)?t.tm_mday+1:1; |
TickTock | 25:ddf0ec209f03 | 548 | } else { |
TickTock | 25:ddf0ec209f03 | 549 | t.tm_mday = (t.tm_mday>2)?t.tm_mday-1:31; |
TickTock | 25:ddf0ec209f03 | 550 | } |
TickTock | 25:ddf0ec209f03 | 551 | break; |
TickTock | 25:ddf0ec209f03 | 552 | case 3: // hour |
TickTock | 25:ddf0ec209f03 | 553 | if (upDownBar) { |
TickTock | 25:ddf0ec209f03 | 554 | t.tm_hour = (t.tm_hour<23)?t.tm_hour+1:0; |
TickTock | 25:ddf0ec209f03 | 555 | } else { |
TickTock | 25:ddf0ec209f03 | 556 | t.tm_hour = (t.tm_hour>1)?t.tm_hour-1:23; |
TickTock | 25:ddf0ec209f03 | 557 | } |
TickTock | 25:ddf0ec209f03 | 558 | break; |
TickTock | 25:ddf0ec209f03 | 559 | case 4: // minute |
TickTock | 25:ddf0ec209f03 | 560 | if (upDownBar) { |
TickTock | 25:ddf0ec209f03 | 561 | t.tm_min = (t.tm_min<59)?t.tm_min+1:0; |
TickTock | 25:ddf0ec209f03 | 562 | } else { |
TickTock | 25:ddf0ec209f03 | 563 | t.tm_min = (t.tm_min>1)?t.tm_min-1:59; |
TickTock | 25:ddf0ec209f03 | 564 | } |
TickTock | 25:ddf0ec209f03 | 565 | break; |
TickTock | 25:ddf0ec209f03 | 566 | case 5: // second |
TickTock | 25:ddf0ec209f03 | 567 | if (upDownBar) { |
TickTock | 25:ddf0ec209f03 | 568 | t.tm_sec = (t.tm_sec<59)?t.tm_sec+1:0; |
TickTock | 25:ddf0ec209f03 | 569 | } else { |
TickTock | 25:ddf0ec209f03 | 570 | t.tm_sec = (t.tm_sec>1)?t.tm_sec-1:59; |
TickTock | 25:ddf0ec209f03 | 571 | } |
TickTock | 25:ddf0ec209f03 | 572 | break; |
TickTock | 25:ddf0ec209f03 | 573 | default: |
TickTock | 25:ddf0ec209f03 | 574 | break; |
TickTock | 25:ddf0ec209f03 | 575 | } |
TickTock | 25:ddf0ec209f03 | 576 | set_time(mktime(&t)); |
TickTock | 25:ddf0ec209f03 | 577 | } |
TickTock | 25:ddf0ec209f03 | 578 | |
TickTock | 39:eef8beac7411 | 579 | void logPackVoltages() { // Turbo3 - routine to dump CP values to text file |
TickTock | 39:eef8beac7411 | 580 | char sTemp[40]; |
TickTock | 39:eef8beac7411 | 581 | struct tm t; // pointer to a static tm structure |
TickTock | 39:eef8beac7411 | 582 | short unsigned max, min, jv, i, bd; |
TickTock | 39:eef8beac7411 | 583 | unsigned avg; |
TickTock | 39:eef8beac7411 | 584 | unsigned short gids, SOC, packV; |
TickTock | 39:eef8beac7411 | 585 | signed short packA; |
TickTock | 39:eef8beac7411 | 586 | time_t seconds ; |
TickTock | 39:eef8beac7411 | 587 | |
TickTock | 39:eef8beac7411 | 588 | CANMessage msg; |
TickTock | 39:eef8beac7411 | 589 | |
TickTock | 39:eef8beac7411 | 590 | seconds = time(NULL); // Turbo3 |
TickTock | 39:eef8beac7411 | 591 | t = *localtime(&seconds) ; // Turbo3 |
TickTock | 39:eef8beac7411 | 592 | |
TickTock | 39:eef8beac7411 | 593 | msg = lastMsg[indexLastMsg[0x5bc]]; //Get gids |
TickTock | 39:eef8beac7411 | 594 | gids = (msg.data[0]<<2)+(msg.data[1]>>6); |
TickTock | 39:eef8beac7411 | 595 | msg = lastMsg[indexLastMsg[0x55b]]; //Get SOC |
TickTock | 39:eef8beac7411 | 596 | SOC = (msg.data[0]<<2)+(msg.data[1]>>6); |
TickTock | 39:eef8beac7411 | 597 | msg = lastMsg[indexLastMsg[0x1db]]; //Get pack volts |
TickTock | 39:eef8beac7411 | 598 | packV = (msg.data[2]<<2)+(msg.data[3]>>6); |
TickTock | 39:eef8beac7411 | 599 | packA = (msg.data[0]<<3)+(msg.data[1]>>5); |
TickTock | 39:eef8beac7411 | 600 | if (packA & 0x400) packA |= 0xf800; |
TickTock | 39:eef8beac7411 | 601 | |
TickTock | 39:eef8beac7411 | 602 | max=0; |
TickTock | 39:eef8beac7411 | 603 | min=9999; |
TickTock | 39:eef8beac7411 | 604 | avg=0; |
TickTock | 39:eef8beac7411 | 605 | for(i=0; i<96; i++) { |
TickTock | 39:eef8beac7411 | 606 | bd=(battData[i*2+3]<<8)+battData[i*2+4]; |
TickTock | 39:eef8beac7411 | 607 | avg+=bd; |
TickTock | 39:eef8beac7411 | 608 | if(bd>max) max=bd; |
TickTock | 39:eef8beac7411 | 609 | if(bd<min) min=bd; |
TickTock | 39:eef8beac7411 | 610 | } |
TickTock | 39:eef8beac7411 | 611 | avg /= 96; |
TickTock | 39:eef8beac7411 | 612 | if(min<3713) { |
TickTock | 39:eef8beac7411 | 613 | jv=avg-(max-avg)*1.5; |
TickTock | 39:eef8beac7411 | 614 | } else { // Only compute judgement value if min cellpair meets <= 3712mV requirement |
TickTock | 39:eef8beac7411 | 615 | jv=0; |
TickTock | 39:eef8beac7411 | 616 | } |
TickTock | 39:eef8beac7411 | 617 | |
TickTock | 39:eef8beac7411 | 618 | FILE *bfile; |
TickTock | 39:eef8beac7411 | 619 | //bfile = fopen("/local/batvolt.txt", "a"); |
TickTock | 39:eef8beac7411 | 620 | bfile = fopen("/usb/batvolt.txt", "a"); |
TickTock | 39:eef8beac7411 | 621 | if(bfile!=NULL) { |
TickTock | 39:eef8beac7411 | 622 | strftime(sTemp, 40, "%a %m/%d/%Y %X", &t); |
TickTock | 39:eef8beac7411 | 623 | 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 | 624 | 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 | 625 | 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 | 626 | for(i=0; i<96; i++) { |
TickTock | 39:eef8beac7411 | 627 | bd=(battData[i*2+3]<<8)+battData[i*2+4]; |
TickTock | 39:eef8beac7411 | 628 | fprintf(bfile,",%d",bd); |
TickTock | 39:eef8beac7411 | 629 | } |
TickTock | 39:eef8beac7411 | 630 | fprintf(bfile,"\r\n"); |
TickTock | 39:eef8beac7411 | 631 | fclose(bfile); |
TickTock | 39:eef8beac7411 | 632 | } |
TickTock | 39:eef8beac7411 | 633 | logCP=false; |
TickTock | 40:0e6e71a7323f | 634 | showCP=true; |
TickTock | 39:eef8beac7411 | 635 | } |
TickTock | 25:ddf0ec209f03 | 636 |