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@39:eef8beac7411, 2013-03-25 (annotated)

Committer:
TickTock
Date:
Mon Mar 25 15:13:15 2013 +0000
Revision:
39:eef8beac7411
Parent:
38:155ec32c5e91
Child:
40:0e6e71a7323f
Fixed minor bug using tick to trigger refresh (changed to using change on accV)

Who changed what in which revision?

UserRevisionLine numberNew contents of line
TickTock 13:62e0f7f39ff5 1 // utility.cpp
TickTock 13:62e0f7f39ff5 2 #include "utility.h"
TickTock 13:62e0f7f39ff5 3
TickTock 13:62e0f7f39ff5 4 void mbed_reset();
TickTock 22:a43df3905863 5
TickTock 13:62e0f7f39ff5 6 void RTC_IRQHandler() {
TickTock 13:62e0f7f39ff5 7 timer.reset(); // zero ms at the-seconds-tic
TickTock 20:3bf176d14b14 8 canIdle=(++secsNoMsg>canTimeout)?true:false;
TickTock 20:3bf176d14b14 9 userIdle=(++secsNoTouch>userTimeout)?true:false;
TickTock 13:62e0f7f39ff5 10 LPC_RTC->ILR |= (1<<0); // clear interrupt to prepare for next
TickTock 34:4751a8259b18 11 tick=true;
TickTock 13:62e0f7f39ff5 12 }
TickTock 13:62e0f7f39ff5 13
TickTock 37:fea2c1d52c5f 14 void RTC_Init (void) {
TickTock 13:62e0f7f39ff5 15 LPC_RTC->ILR=0x00; // set up the RTC interrupts
TickTock 13:62e0f7f39ff5 16 LPC_RTC->CIIR=0x01; // interrupts each second
TickTock 13:62e0f7f39ff5 17 LPC_RTC->CCR = 0x01; // Clock enable
TickTock 13:62e0f7f39ff5 18 //NVIC_SetPriority( RTC_IRQn, 10 );
TickTock 13:62e0f7f39ff5 19 NVIC_EnableIRQ( RTC_IRQn );
TickTock 13:62e0f7f39ff5 20 }
TickTock 13:62e0f7f39ff5 21
TickTock 13:62e0f7f39ff5 22 void logMsg (char *msg) {
TickTock 13:62e0f7f39ff5 23 strcpy(displayLog[displayLoc],msg);
TickTock 13:62e0f7f39ff5 24 displayLoc=displayLoc>17?0:displayLoc+1;
TickTock 13:62e0f7f39ff5 25 }
TickTock 13:62e0f7f39ff5 26
TickTock 13:62e0f7f39ff5 27 void touch_ISR(){
TickTock 37:fea2c1d52c5f 28 //LPC_GPIOINT->IO2IntClr = (LPC_GPIOINT->IO2IntStatR | LPC_GPIOINT->IO2IntStatF); // seems to work without so maybe not necessary (performed inInterruptIn handler?)
TickTock 35:5acbd8a64a89 29 touched=true; // just set flag - touch screen algorythm is long and we don't want to block other interrupts
TickTock 13:62e0f7f39ff5 30 }
TickTock 13:62e0f7f39ff5 31
TickTock 13:62e0f7f39ff5 32 unsigned short getTimeStamp() {
TickTock 13:62e0f7f39ff5 33 unsigned short msec = timer.read_ms() ; // read ms from the timer
TickTock 13:62e0f7f39ff5 34 unsigned long secs = time(NULL); // seconds past 12:00:00 AM 1 Jan 1900
TickTock 13:62e0f7f39ff5 35 unsigned short isecs = secs%60 ; // modulo 60 for 0-59 seconds from RTC
TickTock 13:62e0f7f39ff5 36 return ((isecs<<10)+msec) ; // return the two byte time stamp
TickTock 13:62e0f7f39ff5 37 }
TickTock 13:62e0f7f39ff5 38
TickTock 13:62e0f7f39ff5 39 void logCan (char mType, CANMessage canRXmsg) {
TickTock 13:62e0f7f39ff5 40 char sTemp[40];
TickTock 13:62e0f7f39ff5 41 unsigned short ts = getTimeStamp();
TickTock 13:62e0f7f39ff5 42 static unsigned char ii = 0, lasti = 0; // indexindex
TickTock 13:62e0f7f39ff5 43 unsigned char changed,i;
TickTock 37:fea2c1d52c5f 44 static unsigned char bdi=0;
TickTock 37:fea2c1d52c5f 45 //Determined 1db messages are 10ms apart so no need to compute deltaT
TickTock 37:fea2c1d52c5f 46 //unsigned short ms;
TickTock 37:fea2c1d52c5f 47 //static unsigned short lms=0;
TickTock 37:fea2c1d52c5f 48 unsigned short packV;
TickTock 37:fea2c1d52c5f 49 signed short packA;
TickTock 37:fea2c1d52c5f 50 signed long imWs;
TickTock 36:dbd39c315258 51 secsNoMsg=0; // reset deadman switch
TickTock 13:62e0f7f39ff5 52 if(logOpen){
TickTock 13:62e0f7f39ff5 53 if(canRXmsg.id>0) {
TickTock 13:62e0f7f39ff5 54 writeBuffer[writePointer][0]=mType;
TickTock 37:fea2c1d52c5f 55 writeBuffer[writePointer][1]=(ts&0xff00)>>8;
TickTock 37:fea2c1d52c5f 56 writeBuffer[writePointer][2]=(ts&0x00ff);
TickTock 13:62e0f7f39ff5 57 writeBuffer[writePointer][3]=canRXmsg.id&0xff;
TickTock 13:62e0f7f39ff5 58 writeBuffer[writePointer][4]=(canRXmsg.id>>8)+(canRXmsg.len<<4);
TickTock 13:62e0f7f39ff5 59 for(i=5;i<13;i++){
TickTock 13:62e0f7f39ff5 60 writeBuffer[writePointer][i]=canRXmsg.data[i-5];
TickTock 13:62e0f7f39ff5 61 }
TickTock 13:62e0f7f39ff5 62 if (++writePointer >= maxBufLen) {
TickTock 13:62e0f7f39ff5 63 writePointer = 0;
TickTock 13:62e0f7f39ff5 64 led3 = !led3;
TickTock 13:62e0f7f39ff5 65 }
TickTock 13:62e0f7f39ff5 66 }
TickTock 37:fea2c1d52c5f 67 }
TickTock 37:fea2c1d52c5f 68 //Determined 1db messages are 10ms apart so no need to compute deltaT
TickTock 37:fea2c1d52c5f 69 /*if(playbackOpen){
TickTock 37:fea2c1d52c5f 70 ts=pbts; // Use ts from playback buffer
TickTock 37:fea2c1d52c5f 71 }//if logOpen*/
TickTock 13:62e0f7f39ff5 72 if(indexLastMsg[canRXmsg.id]==0) { //Check if no entry
TickTock 13:62e0f7f39ff5 73 ii=ii<99?ii+1:0;
TickTock 13:62e0f7f39ff5 74 indexLastMsg[canRXmsg.id]=ii; //Create entry if first message
TickTock 13:62e0f7f39ff5 75 }
TickTock 13:62e0f7f39ff5 76 if(dMode[0]==changedScreen||dMode[1]==changedScreen){
TickTock 13:62e0f7f39ff5 77 changed=msgChanged[indexLastMsg[canRXmsg.id]];
TickTock 13:62e0f7f39ff5 78 for(i=0;i<8;i++){
TickTock 13:62e0f7f39ff5 79 if(lastMsg[indexLastMsg[canRXmsg.id]].data[i]!=canRXmsg.data[i]){
TickTock 13:62e0f7f39ff5 80 changed |= 1<<i;
TickTock 13:62e0f7f39ff5 81 }
TickTock 13:62e0f7f39ff5 82 }
TickTock 13:62e0f7f39ff5 83 msgChanged[indexLastMsg[canRXmsg.id]]=changed;
TickTock 13:62e0f7f39ff5 84 }
TickTock 13:62e0f7f39ff5 85 lastMsg[indexLastMsg[canRXmsg.id]]=canRXmsg; //Store in table
TickTock 34:4751a8259b18 86 if((mType==2)&&(canRXmsg.id==0x358)){ // headlight/turn signal indicator
TickTock 34:4751a8259b18 87 headlights = (canRXmsg.data[1]&0x80)?true:false;
TickTock 37:fea2c1d52c5f 88 }else if((mType==1)&&(canRXmsg.id==0x7bb)){ // is battery data? Need to store all responses
TickTock 13:62e0f7f39ff5 89 if(canRXmsg.data[0]<0x20){
TickTock 13:62e0f7f39ff5 90 if(canRXmsg.data[3]==2){//cellpair data
TickTock 13:62e0f7f39ff5 91 bdi=0;
TickTock 13:62e0f7f39ff5 92 sprintf(sTemp,"Getting cell pair data\n");
TickTock 13:62e0f7f39ff5 93 logMsg(sTemp);
TickTock 37:fea2c1d52c5f 94 }else if(canRXmsg.data[3]==4){//temperature data
TickTock 13:62e0f7f39ff5 95 bdi=0x20;
TickTock 13:62e0f7f39ff5 96 sprintf(sTemp,"Getting temperature data\n");
TickTock 13:62e0f7f39ff5 97 logMsg(sTemp);
TickTock 13:62e0f7f39ff5 98 }else bdi=0;
TickTock 13:62e0f7f39ff5 99 lasti=0;
TickTock 13:62e0f7f39ff5 100 }
TickTock 13:62e0f7f39ff5 101 i=canRXmsg.data[0]&0x0f; //lower nibble of D0 is index
TickTock 34:4751a8259b18 102 if(lasti>i){ //detect rollover and offset index appropriately
TickTock 13:62e0f7f39ff5 103 bdi=0x10;
TickTock 13:62e0f7f39ff5 104 }
TickTock 13:62e0f7f39ff5 105 lasti=i; //remember the msb to detect rollover next time around
TickTock 13:62e0f7f39ff5 106 i+=bdi;
TickTock 13:62e0f7f39ff5 107 i*=7;
TickTock 13:62e0f7f39ff5 108 if(i<0xfa){
TickTock 13:62e0f7f39ff5 109 battData[i+0]=canRXmsg.data[1];
TickTock 13:62e0f7f39ff5 110 battData[i+1]=canRXmsg.data[2];
TickTock 13:62e0f7f39ff5 111 battData[i+2]=canRXmsg.data[3];
TickTock 13:62e0f7f39ff5 112 battData[i+3]=canRXmsg.data[4];
TickTock 13:62e0f7f39ff5 113 battData[i+4]=canRXmsg.data[5];
TickTock 13:62e0f7f39ff5 114 battData[i+5]=canRXmsg.data[6];
TickTock 13:62e0f7f39ff5 115 battData[i+6]=canRXmsg.data[7];
TickTock 13:62e0f7f39ff5 116 }
TickTock 37:fea2c1d52c5f 117 }else if((mType==1)&&(canRXmsg.id==0x1db)){ //Battery Volts and Amps
TickTock 37:fea2c1d52c5f 118 //Determined 1db messages are 10ms apart so no need to compute deltaT
TickTock 37:fea2c1d52c5f 119 //ms=(ts&0xfc00)*1000+(ts&0x03ff); // convert from BCD(ish-ssssss:mmmmmmmmmm) to binary
TickTock 37:fea2c1d52c5f 120 //if(ms<lms){ // must've rolled over
TickTock 37:fea2c1d52c5f 121 // imWs=ms+60000; // (ms)compute elapsed time since last update including rollover
TickTock 37:fea2c1d52c5f 122 // imWs-=lms;
TickTock 37:fea2c1d52c5f 123 //}else{
TickTock 37:fea2c1d52c5f 124 // imWs=ms-lms; // (ms) compute elapsed time since last update
TickTock 37:fea2c1d52c5f 125 //}
TickTock 37:fea2c1d52c5f 126 packV=((canRXmsg.data[2]<<2)|(canRXmsg.data[3]>>6)); // 1 LSB = 0.5V
TickTock 37:fea2c1d52c5f 127 packA=((canRXmsg.data[0]<<3)|(canRXmsg.data[1]>>5)); // 1 LSB = 0.5A
TickTock 37:fea2c1d52c5f 128 if(packA>0x03ff){
TickTock 37:fea2c1d52c5f 129 packA|=0xf800;//extend sign;
TickTock 37:fea2c1d52c5f 130 }
TickTock 37:fea2c1d52c5f 131 imWs=packV; // Volts*seconds*2
TickTock 37:fea2c1d52c5f 132 imWs*=packA; // Watts*4
TickTock 38:155ec32c5e91 133 imWs*=-10; // milliwatt*seconds*4 (1db messages are 10ms apart)
TickTock 38:155ec32c5e91 134 mWs+=(imWs>>2); // total mWs
TickTock 37:fea2c1d52c5f 135 //lms=ms;
TickTock 37:fea2c1d52c5f 136 }
TickTock 13:62e0f7f39ff5 137 }
TickTock 13:62e0f7f39ff5 138
TickTock 13:62e0f7f39ff5 139 void logTS () {
TickTock 13:62e0f7f39ff5 140 CANMessage tsMsg;
TickTock 13:62e0f7f39ff5 141 unsigned long secs = time(NULL); // seconds past 12:00:00 AM 1 Jan 1900
TickTock 13:62e0f7f39ff5 142 tsMsg.id=0xfff;
TickTock 13:62e0f7f39ff5 143 tsMsg.len=0xf;
TickTock 13:62e0f7f39ff5 144 tsMsg.data[0]=secs&0xff;
TickTock 13:62e0f7f39ff5 145 tsMsg.data[1]=(secs>>8)&0xff;
TickTock 13:62e0f7f39ff5 146 tsMsg.data[2]=(secs>>16)&0xff;
TickTock 13:62e0f7f39ff5 147 tsMsg.data[3]=secs>>24;
TickTock 13:62e0f7f39ff5 148 tsMsg.data[4]=0xff;
TickTock 13:62e0f7f39ff5 149 tsMsg.data[5]=0xff;
TickTock 13:62e0f7f39ff5 150 tsMsg.data[6]=0xff;
TickTock 13:62e0f7f39ff5 151 tsMsg.data[7]=0xff;
TickTock 13:62e0f7f39ff5 152 logCan(0,tsMsg);
TickTock 13:62e0f7f39ff5 153 }
TickTock 13:62e0f7f39ff5 154
TickTock 33:a277743ebdeb 155 void sendCPreq() {
TickTock 13:62e0f7f39ff5 156 char i;
TickTock 13:62e0f7f39ff5 157 char data[8] = {0x02, 0x21, 0x02, 0xff, 0xff, 0xff, 0xff, 0xff};
TickTock 13:62e0f7f39ff5 158 can1.monitor(false); // set to active mode
TickTock 13:62e0f7f39ff5 159 can1SleepMode = 0; // enable TX
TickTock 13:62e0f7f39ff5 160 can1.write(CANMessage(0x79b, data, 8));
TickTock 34:4751a8259b18 161 logCan(1,CANMessage(0x79b, data, 8));
TickTock 13:62e0f7f39ff5 162 data[0]=0x30; //change to request next line message
TickTock 13:62e0f7f39ff5 163 data[1]=0x01;
TickTock 13:62e0f7f39ff5 164 data[2]=0x00;
TickTock 23:cd03f9c3395e 165 for(i=0;i<29;i++){
TickTock 13:62e0f7f39ff5 166 wait_ms(16); //wait 16ms
TickTock 13:62e0f7f39ff5 167 can1.write(CANMessage(0x79b, data, 8));
TickTock 13:62e0f7f39ff5 168 }
TickTock 13:62e0f7f39ff5 169 can1SleepMode = 1; // disable TX
TickTock 13:62e0f7f39ff5 170 can1.monitor(true); // set to snoop mode
TickTock 13:62e0f7f39ff5 171 }
TickTock 13:62e0f7f39ff5 172
TickTock 13:62e0f7f39ff5 173 void sendTreq() {
TickTock 13:62e0f7f39ff5 174 char i;
TickTock 13:62e0f7f39ff5 175 char data[8] = {0x02, 0x21, 0x04, 0xff, 0xff, 0xff, 0xff, 0xff};
TickTock 13:62e0f7f39ff5 176 can1.monitor(false); // set to active mode
TickTock 13:62e0f7f39ff5 177 can1SleepMode = 0; // enable TX
TickTock 13:62e0f7f39ff5 178 can1.write(CANMessage(0x79b, data, 8));
TickTock 34:4751a8259b18 179 logCan(1,CANMessage(0x79b, data, 8));
TickTock 13:62e0f7f39ff5 180 data[0]=0x30; //change to request next line message
TickTock 13:62e0f7f39ff5 181 data[1]=0x01;
TickTock 13:62e0f7f39ff5 182 data[2]=0x00;
TickTock 23:cd03f9c3395e 183 for(i=0;i<3;i++){
TickTock 13:62e0f7f39ff5 184 wait_ms(16); //wait 16ms
TickTock 13:62e0f7f39ff5 185 can1.write(CANMessage(0x79b, data, 8));
TickTock 13:62e0f7f39ff5 186 }
TickTock 13:62e0f7f39ff5 187 can1SleepMode = 1; // disable TX
TickTock 13:62e0f7f39ff5 188 can1.monitor(true); // set to snoop mode
TickTock 31:082372c83f68 189 }
TickTock 31:082372c83f68 190
TickTock 36:dbd39c315258 191 void autoPollISR() { //This is the ticker ISR for auto-polling
TickTock 33:a277743ebdeb 192 pollCP=true; //Set a flag to do in main loop instead of here
TickTock 33:a277743ebdeb 193 } //since ticker blocks other interrupts
TickTock 13:62e0f7f39ff5 194
TickTock 36:dbd39c315258 195 void playbackISR() { //Used for autoplayback
TickTock 36:dbd39c315258 196 step=true;
TickTock 36:dbd39c315258 197 }
TickTock 36:dbd39c315258 198
TickTock 36:dbd39c315258 199 void doNothing(){ //CAN deattach work-around
TickTock 36:dbd39c315258 200 }
TickTock 36:dbd39c315258 201
TickTock 13:62e0f7f39ff5 202 void recieve1() {
TickTock 13:62e0f7f39ff5 203 CANMessage msg1;
TickTock 13:62e0f7f39ff5 204 can1.read(msg1);
TickTock 33:a277743ebdeb 205 logCan(1, msg1); //EVcan
TickTock 13:62e0f7f39ff5 206 led1 = !led1;
TickTock 13:62e0f7f39ff5 207 }
TickTock 13:62e0f7f39ff5 208
TickTock 13:62e0f7f39ff5 209 void recieve2() {
TickTock 13:62e0f7f39ff5 210 CANMessage msg2;
TickTock 13:62e0f7f39ff5 211 can2.read(msg2);
TickTock 33:a277743ebdeb 212 logCan(2, msg2); //CARcan
TickTock 13:62e0f7f39ff5 213 led2 = !led2;
TickTock 13:62e0f7f39ff5 214 }
TickTock 13:62e0f7f39ff5 215
TickTock 22:a43df3905863 216 unsigned char buttonX(unsigned short X, unsigned char columns) {
TickTock 22:a43df3905863 217 unsigned char val = X*columns/320;
TickTock 22:a43df3905863 218 return val;
TickTock 22:a43df3905863 219 }
TickTock 22:a43df3905863 220
TickTock 22:a43df3905863 221 unsigned char buttonY(unsigned short Y, unsigned char rows) {
TickTock 22:a43df3905863 222 unsigned short val = Y*rows/240;
TickTock 22:a43df3905863 223 return val;
TickTock 22:a43df3905863 224 }
TickTock 23:cd03f9c3395e 225
TickTock 23:cd03f9c3395e 226 void saveConfig(){
TickTock 23:cd03f9c3395e 227 FILE *cfile;
TickTock 23:cd03f9c3395e 228 cfile = fopen("/local/config.txt", "w");
TickTock 35:5acbd8a64a89 229 fprintf(cfile,"format 2\r\n");
TickTock 23:cd03f9c3395e 230 fprintf(cfile,"x0_off %d\r\n",tt.x0_off);
TickTock 23:cd03f9c3395e 231 fprintf(cfile,"y0_off %d\r\n",tt.y0_off);
TickTock 23:cd03f9c3395e 232 fprintf(cfile,"x0_pp %d\r\n",tt.x0_pp);
TickTock 23:cd03f9c3395e 233 fprintf(cfile,"y0_pp %d\r\n",tt.y0_pp);
TickTock 23:cd03f9c3395e 234 fprintf(cfile,"x1_off %d\r\n",tt.x1_off);
TickTock 23:cd03f9c3395e 235 fprintf(cfile,"y1_off %d\r\n",tt.y1_off);
TickTock 23:cd03f9c3395e 236 fprintf(cfile,"x1_pp %d\r\n",tt.x1_pp);
TickTock 23:cd03f9c3395e 237 fprintf(cfile,"y1_pp %d\r\n",tt.y1_pp);
TickTock 23:cd03f9c3395e 238 fprintf(cfile,"x_mid %d\r\n",tt.x_mid);
TickTock 26:462ccb580472 239 if (dMode[0]==config1Screen)
TickTock 26:462ccb580472 240 fprintf(cfile,"dMode0 %d\r\n",dteScreen);
TickTock 26:462ccb580472 241 else
TickTock 26:462ccb580472 242 fprintf(cfile,"dMode0 %d\r\n",dMode[0]);
TickTock 26:462ccb580472 243 if (dMode[1]==config1Screen)
TickTock 26:462ccb580472 244 fprintf(cfile,"dMode1 %d\r\n",dteScreen);
TickTock 26:462ccb580472 245 else
TickTock 26:462ccb580472 246 fprintf(cfile,"dMode1 %d\r\n",dMode[1]);
TickTock 35:5acbd8a64a89 247 fprintf(cfile,"ledHi %4.3f\r\n",ledHi);
TickTock 35:5acbd8a64a89 248 fprintf(cfile,"ledLo %4.3f\r\n",ledLo);
TickTock 35:5acbd8a64a89 249 fprintf(cfile,"pollInt %d\r\n",pollInt);
TickTock 35:5acbd8a64a89 250 fprintf(cfile,"scale12V %4.2f\r\n",scale12V);
TickTock 23:cd03f9c3395e 251 fclose(cfile);
TickTock 23:cd03f9c3395e 252 }
TickTock 23:cd03f9c3395e 253
TickTock 23:cd03f9c3395e 254 void readConfig(){
TickTock 23:cd03f9c3395e 255 FILE *cfile;
TickTock 23:cd03f9c3395e 256 int ff;
TickTock 23:cd03f9c3395e 257 char sTemp[40];
TickTock 23:cd03f9c3395e 258 cfile = fopen("/local/config.txt", "r");
TickTock 23:cd03f9c3395e 259 if (cfile==NULL){ // if doesn't exist --> create
TickTock 23:cd03f9c3395e 260 sprintf(sTemp,"No config file found.\n");
TickTock 23:cd03f9c3395e 261 logMsg(sTemp);
TickTock 23:cd03f9c3395e 262 sprintf(sTemp,"Calibrating touch screen.\n");
TickTock 23:cd03f9c3395e 263 logMsg(sTemp);
TickTock 23:cd03f9c3395e 264 //tt.setcal(5570, 34030, 80, 108, 33700, 5780, 82, 108, 32500);// bypass calibration using my values
TickTock 23:cd03f9c3395e 265 tt.calibrate(); // run touchscreen calibration routine
TickTock 23:cd03f9c3395e 266 saveConfig();
TickTock 23:cd03f9c3395e 267 } else {
TickTock 23:cd03f9c3395e 268 sprintf(sTemp,"Reading config file.\n");
TickTock 23:cd03f9c3395e 269 logMsg(sTemp);
TickTock 23:cd03f9c3395e 270 //tt.setcal(5570, 34030, 80, 108, 33700, 5780, 82, 108, 32500);// bypass calibration using my values
TickTock 23:cd03f9c3395e 271 fscanf(cfile, "format %c\r\n", &ff ) ;
TickTock 23:cd03f9c3395e 272 fscanf(cfile, "x0_off %d\r\n", &tt.x0_off ) ;
TickTock 23:cd03f9c3395e 273 fscanf(cfile, "y0_off %d\r\n", &tt.y0_off ) ;
TickTock 23:cd03f9c3395e 274 fscanf(cfile, "x0_pp %d\r\n", &tt.x0_pp ) ;
TickTock 23:cd03f9c3395e 275 fscanf(cfile, "y0_pp %d\r\n", &tt.y0_pp ) ;
TickTock 23:cd03f9c3395e 276 fscanf(cfile, "x1_off %d\r\n", &tt.x1_off ) ;
TickTock 23:cd03f9c3395e 277 fscanf(cfile, "y1_off %d\r\n", &tt.y1_off ) ;
TickTock 23:cd03f9c3395e 278 fscanf(cfile, "x1_pp %d\r\n", &tt.x1_pp ) ;
TickTock 23:cd03f9c3395e 279 fscanf(cfile, "y1_pp %d\r\n", &tt.y1_pp ) ;
TickTock 23:cd03f9c3395e 280 fscanf(cfile, "x_mid %d\r\n", &tt.x_mid ) ;
TickTock 26:462ccb580472 281 fscanf(cfile, "dMode0 %d\r\n", &dMode[0] ) ;
TickTock 26:462ccb580472 282 fscanf(cfile, "dMode1 %d\r\n", &dMode[1] ) ;
TickTock 35:5acbd8a64a89 283 if(ff>1){
TickTock 35:5acbd8a64a89 284 fscanf(cfile, "ledHi %4.3f\r\n", &ledHi ) ;
TickTock 35:5acbd8a64a89 285 fscanf(cfile, "ledLo %4.3f\r\n", &ledLo ) ;
TickTock 35:5acbd8a64a89 286 fscanf(cfile, "pollInt %d\r\n", &pollInt ) ;
TickTock 35:5acbd8a64a89 287 fscanf(cfile, "scale12V %4.2f\r\n", &scale12V ) ;
TickTock 35:5acbd8a64a89 288 }else{ //old format - set defaults
TickTock 35:5acbd8a64a89 289 ledHi = 0.8;
TickTock 35:5acbd8a64a89 290 ledLo = 0.1;
TickTock 35:5acbd8a64a89 291 pollInt = 300;
TickTock 35:5acbd8a64a89 292 scale12V = 16.2;
TickTock 35:5acbd8a64a89 293 }
TickTock 23:cd03f9c3395e 294 fclose(cfile);
TickTock 35:5acbd8a64a89 295 if(ff<2) //If not latest format, save as latest format
TickTock 35:5acbd8a64a89 296 saveConfig();
TickTock 23:cd03f9c3395e 297 }
TickTock 23:cd03f9c3395e 298 }
TickTock 25:ddf0ec209f03 299
TickTock 25:ddf0ec209f03 300 void upDate(unsigned char field, bool upDownBar){
TickTock 25:ddf0ec209f03 301 struct tm t; // pointer to a static tm structure
TickTock 25:ddf0ec209f03 302 time_t seconds ;
TickTock 25:ddf0ec209f03 303 seconds = time(NULL);
TickTock 25:ddf0ec209f03 304 t = *localtime(&seconds) ;
TickTock 25:ddf0ec209f03 305 switch(field){
TickTock 25:ddf0ec209f03 306 case 0: // year
TickTock 25:ddf0ec209f03 307 if (upDownBar) {
TickTock 25:ddf0ec209f03 308 t.tm_year = t.tm_year+1;
TickTock 25:ddf0ec209f03 309 } else {
TickTock 25:ddf0ec209f03 310 t.tm_year = t.tm_year-1;
TickTock 25:ddf0ec209f03 311 }
TickTock 25:ddf0ec209f03 312 break;
TickTock 25:ddf0ec209f03 313 case 1: // month
TickTock 25:ddf0ec209f03 314 if (upDownBar) {
TickTock 25:ddf0ec209f03 315 t.tm_mon = (t.tm_mon<12)?t.tm_mon+1:1;
TickTock 25:ddf0ec209f03 316 } else {
TickTock 25:ddf0ec209f03 317 t.tm_mon = (t.tm_mon>2)?t.tm_mon-1:12;
TickTock 25:ddf0ec209f03 318 }
TickTock 25:ddf0ec209f03 319 break;
TickTock 25:ddf0ec209f03 320 case 2: // day
TickTock 25:ddf0ec209f03 321 if (upDownBar) {
TickTock 25:ddf0ec209f03 322 t.tm_mday = (t.tm_mday<31)?t.tm_mday+1:1;
TickTock 25:ddf0ec209f03 323 } else {
TickTock 25:ddf0ec209f03 324 t.tm_mday = (t.tm_mday>2)?t.tm_mday-1:31;
TickTock 25:ddf0ec209f03 325 }
TickTock 25:ddf0ec209f03 326 break;
TickTock 25:ddf0ec209f03 327 case 3: // hour
TickTock 25:ddf0ec209f03 328 if (upDownBar) {
TickTock 25:ddf0ec209f03 329 t.tm_hour = (t.tm_hour<23)?t.tm_hour+1:0;
TickTock 25:ddf0ec209f03 330 } else {
TickTock 25:ddf0ec209f03 331 t.tm_hour = (t.tm_hour>1)?t.tm_hour-1:23;
TickTock 25:ddf0ec209f03 332 }
TickTock 25:ddf0ec209f03 333 break;
TickTock 25:ddf0ec209f03 334 case 4: // minute
TickTock 25:ddf0ec209f03 335 if (upDownBar) {
TickTock 25:ddf0ec209f03 336 t.tm_min = (t.tm_min<59)?t.tm_min+1:0;
TickTock 25:ddf0ec209f03 337 } else {
TickTock 25:ddf0ec209f03 338 t.tm_min = (t.tm_min>1)?t.tm_min-1:59;
TickTock 25:ddf0ec209f03 339 }
TickTock 25:ddf0ec209f03 340 break;
TickTock 25:ddf0ec209f03 341 case 5: // second
TickTock 25:ddf0ec209f03 342 if (upDownBar) {
TickTock 25:ddf0ec209f03 343 t.tm_sec = (t.tm_sec<59)?t.tm_sec+1:0;
TickTock 25:ddf0ec209f03 344 } else {
TickTock 25:ddf0ec209f03 345 t.tm_sec = (t.tm_sec>1)?t.tm_sec-1:59;
TickTock 25:ddf0ec209f03 346 }
TickTock 25:ddf0ec209f03 347 break;
TickTock 25:ddf0ec209f03 348 default:
TickTock 25:ddf0ec209f03 349 break;
TickTock 25:ddf0ec209f03 350 }
TickTock 25:ddf0ec209f03 351 set_time(mktime(&t));
TickTock 25:ddf0ec209f03 352 }
TickTock 25:ddf0ec209f03 353
TickTock 39:eef8beac7411 354 void logPackVoltages() { // Turbo3 - routine to dump CP values to text file
TickTock 39:eef8beac7411 355 char sTemp[40];
TickTock 39:eef8beac7411 356 struct tm t; // pointer to a static tm structure
TickTock 39:eef8beac7411 357 short unsigned max, min, jv, i, bd;
TickTock 39:eef8beac7411 358 unsigned avg;
TickTock 39:eef8beac7411 359 unsigned short gids, SOC, packV;
TickTock 39:eef8beac7411 360 signed short packA;
TickTock 39:eef8beac7411 361 time_t seconds ;
TickTock 39:eef8beac7411 362
TickTock 39:eef8beac7411 363 CANMessage msg;
TickTock 39:eef8beac7411 364
TickTock 39:eef8beac7411 365 seconds = time(NULL); // Turbo3
TickTock 39:eef8beac7411 366 t = *localtime(&seconds) ; // Turbo3
TickTock 39:eef8beac7411 367
TickTock 39:eef8beac7411 368 msg = lastMsg[indexLastMsg[0x5bc]]; //Get gids
TickTock 39:eef8beac7411 369 gids = (msg.data[0]<<2)+(msg.data[1]>>6);
TickTock 39:eef8beac7411 370 msg = lastMsg[indexLastMsg[0x55b]]; //Get SOC
TickTock 39:eef8beac7411 371 SOC = (msg.data[0]<<2)+(msg.data[1]>>6);
TickTock 39:eef8beac7411 372 msg = lastMsg[indexLastMsg[0x1db]]; //Get pack volts
TickTock 39:eef8beac7411 373 packV = (msg.data[2]<<2)+(msg.data[3]>>6);
TickTock 39:eef8beac7411 374 packA = (msg.data[0]<<3)+(msg.data[1]>>5);
TickTock 39:eef8beac7411 375 if (packA & 0x400) packA |= 0xf800;
TickTock 39:eef8beac7411 376
TickTock 39:eef8beac7411 377 max=0;
TickTock 39:eef8beac7411 378 min=9999;
TickTock 39:eef8beac7411 379 avg=0;
TickTock 39:eef8beac7411 380 for(i=0; i<96; i++) {
TickTock 39:eef8beac7411 381 bd=(battData[i*2+3]<<8)+battData[i*2+4];
TickTock 39:eef8beac7411 382 avg+=bd;
TickTock 39:eef8beac7411 383 if(bd>max) max=bd;
TickTock 39:eef8beac7411 384 if(bd<min) min=bd;
TickTock 39:eef8beac7411 385 }
TickTock 39:eef8beac7411 386 avg /= 96;
TickTock 39:eef8beac7411 387 if(min<3713) {
TickTock 39:eef8beac7411 388 jv=avg-(max-avg)*1.5;
TickTock 39:eef8beac7411 389 } else { // Only compute judgement value if min cellpair meets <= 3712mV requirement
TickTock 39:eef8beac7411 390 jv=0;
TickTock 39:eef8beac7411 391 }
TickTock 39:eef8beac7411 392
TickTock 39:eef8beac7411 393 FILE *bfile;
TickTock 39:eef8beac7411 394 //bfile = fopen("/local/batvolt.txt", "a");
TickTock 39:eef8beac7411 395 bfile = fopen("/usb/batvolt.txt", "a");
TickTock 39:eef8beac7411 396 if(bfile!=NULL) {
TickTock 39:eef8beac7411 397 strftime(sTemp, 40, "%a %m/%d/%Y %X", &t);
TickTock 39:eef8beac7411 398 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 399 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 400 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 401 for(i=0; i<96; i++) {
TickTock 39:eef8beac7411 402 bd=(battData[i*2+3]<<8)+battData[i*2+4];
TickTock 39:eef8beac7411 403 fprintf(bfile,",%d",bd);
TickTock 39:eef8beac7411 404 }
TickTock 39:eef8beac7411 405 fprintf(bfile,"\r\n");
TickTock 39:eef8beac7411 406 fclose(bfile);
TickTock 39:eef8beac7411 407 }
TickTock 39:eef8beac7411 408 logCP=false;
TickTock 39:eef8beac7411 409 }
TickTock 25:ddf0ec209f03 410