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@170:7ee98e3611bc, 2013-12-24 (annotated)

Committer:
TickTock
Date:
Tue Dec 24 12:20:50 2013 +0000
Revision:
170:7ee98e3611bc
Parent:
169:84d790ac18a2
Child:
174:cd27e80f197d
// Added kWperGid scalar to config file.  .075 appears to be too small; // Added CCkWh_trip to TripLog (after kWh_trip); // Added uncalibrated available regen bars to dte screen

Who changed what in which revision?

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