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