test fork

Dependencies:   SPI_TFTx2 SPI_TFTx2_ILI9341 TFT_fonts TOUCH_TFTx2 mbed

Fork of CANary_9341 by Tick Tock

Committer:
TickTock
Date:
Sun Mar 24 17:26:09 2013 +0000
Revision:
38:155ec32c5e91
Parent:
37:fea2c1d52c5f
Child:
39:eef8beac7411
Fixed kW update routine

Who changed what in which revision?

UserRevisionLine numberNew contents of line
TickTock 13:62e0f7f39ff5 1 //displayModes.cpp
TickTock 37:fea2c1d52c5f 2 #include "displayModes.h"
TickTock 13:62e0f7f39ff5 3
TickTock 25:ddf0ec209f03 4 char sTemp1[40];
TickTock 24:6cf76ed8c432 5 char sTemp2[16];
TickTock 13:62e0f7f39ff5 6
TickTock 13:62e0f7f39ff5 7 void printLast (bool force){
TickTock 13:62e0f7f39ff5 8 CANMessage msg;
TickTock 13:62e0f7f39ff5 9 tt.locate(0,6);
TickTock 13:62e0f7f39ff5 10 tt.foreground(Red);
TickTock 13:62e0f7f39ff5 11 tt.background(Yellow);
TickTock 13:62e0f7f39ff5 12 if(force) tt.cls(); // Just clear screen if forced - always update display
TickTock 13:62e0f7f39ff5 13 tt.set_font((unsigned char*) Arial12x12_prop); // select the font
TickTock 13:62e0f7f39ff5 14 for(int i=0; i<19; i++){
TickTock 13:62e0f7f39ff5 15 msg = lastMsg[i+indexOffset];
TickTock 13:62e0f7f39ff5 16 printf("%03x : %02x %02x %02x %02x %02x %02x %02x %02x \n",msg.id,msg.data[0],msg.data[1],msg.data[2],msg.data[3],msg.data[4],msg.data[5],msg.data[6],msg.data[7]);
TickTock 13:62e0f7f39ff5 17 }
TickTock 25:ddf0ec209f03 18 if(sMode==1){
TickTock 25:ddf0ec209f03 19 tt.foreground(Yellow);
TickTock 25:ddf0ec209f03 20 tt.background(DarkCyan);
TickTock 25:ddf0ec209f03 21 tt.set_font((unsigned char*) Arial12x12);
TickTock 25:ddf0ec209f03 22 sprintf(sTemp1,"<up>");
TickTock 25:ddf0ec209f03 23 sprintf(sTemp2,"");
TickTock 25:ddf0ec209f03 24 showButton(0,0,sTemp1,sTemp2,3,3);
TickTock 25:ddf0ec209f03 25 tt.foreground(Yellow);
TickTock 25:ddf0ec209f03 26 tt.background(DarkCyan);
TickTock 25:ddf0ec209f03 27 tt.set_font((unsigned char*) Arial12x12);
TickTock 25:ddf0ec209f03 28 sprintf(sTemp1,"<down>");
TickTock 25:ddf0ec209f03 29 showButton(2,0,sTemp1,sTemp2,3,3);
TickTock 25:ddf0ec209f03 30 }
TickTock 13:62e0f7f39ff5 31 }
TickTock 13:62e0f7f39ff5 32
TickTock 13:62e0f7f39ff5 33 void printChanged (bool force){
TickTock 13:62e0f7f39ff5 34 CANMessage msg;
TickTock 13:62e0f7f39ff5 35 unsigned char i,j;
TickTock 13:62e0f7f39ff5 36 tt.locate(0,6);
TickTock 13:62e0f7f39ff5 37 tt.foreground(Red);
TickTock 13:62e0f7f39ff5 38 tt.background(Yellow);
TickTock 13:62e0f7f39ff5 39 if(force) tt.cls(); // Just clear screen if forced - always update display
TickTock 13:62e0f7f39ff5 40 tt.set_font((unsigned char*) Arial12x12_prop); // select the font
TickTock 13:62e0f7f39ff5 41 i=0;
TickTock 13:62e0f7f39ff5 42 j=indexOffset;
TickTock 13:62e0f7f39ff5 43 do{
TickTock 13:62e0f7f39ff5 44 j=j<99?j+1:j;
TickTock 13:62e0f7f39ff5 45 if(msgChanged[j]>0){
TickTock 13:62e0f7f39ff5 46 msg = lastMsg[j];
TickTock 13:62e0f7f39ff5 47 printf("%03x : %02x %02x %02x %02x %02x %02x %02x %02x \n",msg.id,msg.data[0],msg.data[1],msg.data[2],msg.data[3],msg.data[4],msg.data[5],msg.data[6],msg.data[7]);
TickTock 13:62e0f7f39ff5 48 i++;
TickTock 13:62e0f7f39ff5 49 }// if changed
TickTock 13:62e0f7f39ff5 50 }while(i<19&&j<99);
TickTock 13:62e0f7f39ff5 51 }
TickTock 13:62e0f7f39ff5 52
TickTock 13:62e0f7f39ff5 53 void printLog (bool force){
TickTock 13:62e0f7f39ff5 54 static unsigned char lastDisplayLoc = 0;
TickTock 13:62e0f7f39ff5 55 if(force||displayLoc!=lastDisplayLoc){ //only update if changed
TickTock 13:62e0f7f39ff5 56 tt.foreground(Amber);
TickTock 13:62e0f7f39ff5 57 tt.background(Black);
TickTock 13:62e0f7f39ff5 58 tt.cls();
TickTock 13:62e0f7f39ff5 59 tt.locate(0,6);
TickTock 13:62e0f7f39ff5 60 tt.set_font((unsigned char*) Arial12x12);
TickTock 13:62e0f7f39ff5 61 for(int i=0; i<19; i++){
TickTock 13:62e0f7f39ff5 62 printf("%s",displayLog[displayLoc]);
TickTock 13:62e0f7f39ff5 63 displayLoc=displayLoc>17?0:displayLoc+1;
TickTock 13:62e0f7f39ff5 64 }
TickTock 13:62e0f7f39ff5 65 }
TickTock 13:62e0f7f39ff5 66 lastDisplayLoc=displayLoc;
TickTock 13:62e0f7f39ff5 67 }
TickTock 13:62e0f7f39ff5 68
TickTock 13:62e0f7f39ff5 69 void printDTE (bool force){
TickTock 13:62e0f7f39ff5 70 unsigned short gids, SOC, packV;
TickTock 13:62e0f7f39ff5 71 static unsigned short lgids=0, lSOC=0, lpackV=0;
TickTock 38:155ec32c5e91 72 static float lmpkWh=0;
TickTock 13:62e0f7f39ff5 73 CANMessage msg;
TickTock 13:62e0f7f39ff5 74
TickTock 13:62e0f7f39ff5 75 msg = lastMsg[indexLastMsg[0x5bc]]; //Get gids
TickTock 13:62e0f7f39ff5 76 gids = (msg.data[0]<<2)+(msg.data[1]>>6);
TickTock 13:62e0f7f39ff5 77 msg = lastMsg[indexLastMsg[0x55b]]; //Get SOC
TickTock 13:62e0f7f39ff5 78 SOC = (msg.data[0]<<2)+(msg.data[1]>>6);
TickTock 13:62e0f7f39ff5 79 msg = lastMsg[indexLastMsg[0x1db]]; //Get pack volts
TickTock 13:62e0f7f39ff5 80 packV = (msg.data[2]<<2)+(msg.data[3]>>6);
TickTock 13:62e0f7f39ff5 81
TickTock 13:62e0f7f39ff5 82 tt.background(Navy);
TickTock 38:155ec32c5e91 83 tt.foreground(Yellow);
TickTock 38:155ec32c5e91 84 tt.set_font((unsigned char*) Arial28x28);
TickTock 13:62e0f7f39ff5 85 if(force) tt.cls();
TickTock 13:62e0f7f39ff5 86 if(force||gids!=lgids){
TickTock 13:62e0f7f39ff5 87 tt.locate(10,10);
TickTock 13:62e0f7f39ff5 88 printf("%4d gids\n",gids);
TickTock 35:5acbd8a64a89 89 tt.locate(20,40);
TickTock 13:62e0f7f39ff5 90 printf("%4.1f kWh\n",(float)gids*0.08);
TickTock 13:62e0f7f39ff5 91 tt.set_font((unsigned char*) SCProSB31x55);
TickTock 13:62e0f7f39ff5 92 tt.foreground(Green);
TickTock 13:62e0f7f39ff5 93 tt.locate(60,96);
TickTock 34:4751a8259b18 94 printf("%4.1f mi \n",(float)(gids-5)*0.31); // Approx for now
TickTock 13:62e0f7f39ff5 95 lgids=gids;
TickTock 38:155ec32c5e91 96 tt.foreground(Yellow);
TickTock 38:155ec32c5e91 97 tt.set_font((unsigned char*) Arial28x28);
TickTock 13:62e0f7f39ff5 98 }
TickTock 13:62e0f7f39ff5 99 if(force||SOC!=lSOC){
TickTock 13:62e0f7f39ff5 100 tt.locate(200,10);
TickTock 13:62e0f7f39ff5 101 printf("%4.1f%s\n",(float)SOC/10,"%");
TickTock 13:62e0f7f39ff5 102 lSOC=SOC;
TickTock 13:62e0f7f39ff5 103 }
TickTock 13:62e0f7f39ff5 104 if(force||packV!=lpackV){
TickTock 13:62e0f7f39ff5 105 tt.locate(200,200);
TickTock 37:fea2c1d52c5f 106 printf("%4.1fV \n",(float)packV/2);
TickTock 13:62e0f7f39ff5 107 lpackV=packV;
TickTock 13:62e0f7f39ff5 108 }
TickTock 35:5acbd8a64a89 109 if(force||tick){
TickTock 35:5acbd8a64a89 110 tt.locate(20,200);
TickTock 35:5acbd8a64a89 111 printf("%4.2fV \n",accV);
TickTock 38:155ec32c5e91 112 }
TickTock 38:155ec32c5e91 113 if(force||mpkWh!=lmpkWh){
TickTock 38:155ec32c5e91 114 tt.locate(180,40);
TickTock 38:155ec32c5e91 115 printf("%3.2fkW \n",mpkWh); //kW for now
TickTock 38:155ec32c5e91 116 lmpkWh=mpkWh;
TickTock 35:5acbd8a64a89 117 }
TickTock 13:62e0f7f39ff5 118 }
TickTock 13:62e0f7f39ff5 119
TickTock 25:ddf0ec209f03 120 void braking (bool force, bool prdata=false){
TickTock 28:f24ac05645d9 121 unsigned long targetBraking, regenBraking;
TickTock 28:f24ac05645d9 122 static unsigned long maxTarget = 1000, maxRegen = 1000, tarDivReg = 1000;
TickTock 28:f24ac05645d9 123 unsigned long temp;
TickTock 28:f24ac05645d9 124 static unsigned char lastPressure[4] = {200,200,200,200};
TickTock 28:f24ac05645d9 125 unsigned char i,r,t;
TickTock 37:fea2c1d52c5f 126 static unsigned char lr=0, lt=0;
TickTock 37:fea2c1d52c5f 127 signed short steering;
TickTock 37:fea2c1d52c5f 128 unsigned short s;
TickTock 37:fea2c1d52c5f 129 static unsigned short ls;
TickTock 37:fea2c1d52c5f 130 unsigned char throttle;
TickTock 37:fea2c1d52c5f 131 static unsigned char lthrottle;
TickTock 28:f24ac05645d9 132 CANMessage msg;
TickTock 28:f24ac05645d9 133
TickTock 37:fea2c1d52c5f 134 msg = lastMsg[indexLastMsg[0x180]]; //Get Throttle position
TickTock 37:fea2c1d52c5f 135 throttle = msg.data[5];
TickTock 37:fea2c1d52c5f 136 msg = lastMsg[indexLastMsg[0x002]]; //Get Steering angle
TickTock 37:fea2c1d52c5f 137 steering = (msg.data[1]<<8)+msg.data[0];
TickTock 37:fea2c1d52c5f 138 s= (unsigned short) ((steering/10)+160)%310;
TickTock 28:f24ac05645d9 139 msg = lastMsg[indexLastMsg[0x1cb]]; //Get Target and Regen
TickTock 28:f24ac05645d9 140 regenBraking = (msg.data[0]<<3)+(msg.data[1]>>5);
TickTock 28:f24ac05645d9 141 targetBraking = (msg.data[2]<<3)+(msg.data[3]>>5);
TickTock 28:f24ac05645d9 142 if ((targetBraking>50)&&(regenBraking>50)){
TickTock 28:f24ac05645d9 143 temp = targetBraking;
TickTock 28:f24ac05645d9 144 temp *= 1000;
TickTock 28:f24ac05645d9 145 temp /= regenBraking;
TickTock 28:f24ac05645d9 146 if (temp<tarDivReg) tarDivReg=temp;
TickTock 28:f24ac05645d9 147 }
TickTock 28:f24ac05645d9 148 if (targetBraking>maxTarget) maxTarget=targetBraking;
TickTock 28:f24ac05645d9 149 if (regenBraking>maxRegen) maxRegen=regenBraking;
TickTock 28:f24ac05645d9 150
TickTock 28:f24ac05645d9 151 msg = lastMsg[indexLastMsg[0x1ca]]; //Get brake pressure
TickTock 28:f24ac05645d9 152 tt.background(Navy);
TickTock 28:f24ac05645d9 153 if (force) {
TickTock 28:f24ac05645d9 154 tt.cls();
TickTock 28:f24ac05645d9 155 tt.rect(0,111,170,239,White);
TickTock 28:f24ac05645d9 156 tt.line(0,207,170,207,White);
TickTock 28:f24ac05645d9 157 tt.line(0,175,170,175,White);
TickTock 28:f24ac05645d9 158 tt.line(0,143,170,143,White);
TickTock 28:f24ac05645d9 159 lastPressure[0] = 200;
TickTock 28:f24ac05645d9 160 lastPressure[1] = 200;
TickTock 28:f24ac05645d9 161 lastPressure[2] = 200;
TickTock 28:f24ac05645d9 162 lastPressure[3] = 200;
TickTock 28:f24ac05645d9 163 }
TickTock 37:fea2c1d52c5f 164
TickTock 37:fea2c1d52c5f 165 if (s!=ls){
TickTock 37:fea2c1d52c5f 166 tt.fillrect(ls,5,ls+9,14, Navy);
TickTock 37:fea2c1d52c5f 167 tt.fillrect(s,5,s+9,14, White);
TickTock 37:fea2c1d52c5f 168 //tt.foreground(Yellow);
TickTock 37:fea2c1d52c5f 169 //tt.set_font((unsigned char*) Arial28x28);
TickTock 37:fea2c1d52c5f 170 //tt.locate(10,40);
TickTock 37:fea2c1d52c5f 171 //printf("%d %d \n",s,ls);
TickTock 37:fea2c1d52c5f 172 ls=s;
TickTock 37:fea2c1d52c5f 173 }
TickTock 37:fea2c1d52c5f 174 if (throttle!=lthrottle){
TickTock 37:fea2c1d52c5f 175 if (throttle>239) throttle=239;
TickTock 37:fea2c1d52c5f 176 if(throttle<lthrottle){
TickTock 37:fea2c1d52c5f 177 tt.fillrect(280,239-lthrottle,310,239-throttle,Navy);
TickTock 37:fea2c1d52c5f 178 }else{
TickTock 37:fea2c1d52c5f 179 tt.fillrect(280,239-throttle,310,239,Yellow);
TickTock 37:fea2c1d52c5f 180 }
TickTock 37:fea2c1d52c5f 181 lthrottle=throttle;
TickTock 37:fea2c1d52c5f 182 }
TickTock 37:fea2c1d52c5f 183
TickTock 28:f24ac05645d9 184 // plot bar graph for each wheel pressure
TickTock 28:f24ac05645d9 185 for (i=0; i<4; i++){
TickTock 28:f24ac05645d9 186 if (msg.data[i]<239) {
TickTock 28:f24ac05645d9 187 if (msg.data[i]>lastPressure[i]){
TickTock 28:f24ac05645d9 188 tt.fillrect(10+40*i,239-msg.data[i],40+40*i,239,Red);
TickTock 28:f24ac05645d9 189 } else if (msg.data[i]<lastPressure[i]) {
TickTock 28:f24ac05645d9 190 tt.fillrect(10+40*i,238-lastPressure[i],40+40*i,238-msg.data[i],Navy);
TickTock 28:f24ac05645d9 191 }
TickTock 28:f24ac05645d9 192 lastPressure[i]=msg.data[i];
TickTock 28:f24ac05645d9 193 }
TickTock 28:f24ac05645d9 194 }
TickTock 28:f24ac05645d9 195
TickTock 28:f24ac05645d9 196 temp = targetBraking;
TickTock 28:f24ac05645d9 197 temp *=200;
TickTock 28:f24ac05645d9 198 temp /= maxTarget;
TickTock 28:f24ac05645d9 199 t = (char) temp;
TickTock 28:f24ac05645d9 200 if (t>200) t=200;
TickTock 28:f24ac05645d9 201 temp = regenBraking;
TickTock 28:f24ac05645d9 202 temp *= tarDivReg;
TickTock 28:f24ac05645d9 203 temp /= maxTarget;
TickTock 28:f24ac05645d9 204 temp /= 5;
TickTock 28:f24ac05645d9 205 r = (char) temp;
TickTock 28:f24ac05645d9 206 if (r>200) r=200;
TickTock 28:f24ac05645d9 207 if(lr!=r&&prdata){
TickTock 28:f24ac05645d9 208 tt.foreground(Yellow);
TickTock 28:f24ac05645d9 209 tt.set_font((unsigned char*) Arial28x28);
TickTock 28:f24ac05645d9 210 tt.locate(100,40);
TickTock 28:f24ac05645d9 211 printf("%d %d \n",regenBraking,maxRegen);
TickTock 28:f24ac05645d9 212 tt.locate(100,70);
TickTock 28:f24ac05645d9 213 printf("%3.1f (%3.1f%s) \n",(float)tarDivReg/10,(float)regenBraking*tarDivReg/targetBraking/10,"%");
TickTock 28:f24ac05645d9 214 }
TickTock 28:f24ac05645d9 215 if(lt!=t&&prdata){
TickTock 28:f24ac05645d9 216 tt.foreground(Yellow);
TickTock 28:f24ac05645d9 217 tt.set_font((unsigned char*) Arial28x28);
TickTock 28:f24ac05645d9 218 tt.locate(100,10);
TickTock 28:f24ac05645d9 219 printf("%d %d \n",targetBraking,maxTarget);
TickTock 28:f24ac05645d9 220 }
TickTock 28:f24ac05645d9 221 if (r>t) t=r; //Should never happen
TickTock 28:f24ac05645d9 222 if((lr!=r||lt!=t)&&!prdata){
TickTock 37:fea2c1d52c5f 223 tt.fillrect(190,10,260,239-t,Navy);
TickTock 37:fea2c1d52c5f 224 tt.fillrect(190,239-t,260,239-r,Red);
TickTock 37:fea2c1d52c5f 225 tt.fillrect(190,239-r,260,239,Green);
TickTock 28:f24ac05645d9 226 }
TickTock 28:f24ac05645d9 227 lt=t;
TickTock 28:f24ac05645d9 228 lr=r;
TickTock 28:f24ac05645d9 229 }
TickTock 28:f24ac05645d9 230
TickTock 36:dbd39c315258 231 void cpData(bool force){
TickTock 36:dbd39c315258 232 short unsigned max, min, jv, i, bd;
TickTock 36:dbd39c315258 233 unsigned avg;
TickTock 36:dbd39c315258 234 if(force){
TickTock 36:dbd39c315258 235 tt.foreground(White);
TickTock 36:dbd39c315258 236 tt.background(Navy);
TickTock 36:dbd39c315258 237 tt.set_font((unsigned char*) Arial12x12_prop); // select the font
TickTock 36:dbd39c315258 238 max=0;
TickTock 36:dbd39c315258 239 min=9999;
TickTock 36:dbd39c315258 240 avg=0;
TickTock 36:dbd39c315258 241 for(i=0; i<96; i++){
TickTock 36:dbd39c315258 242 bd=(battData[i*2+3]<<8)+battData[i*2+4];
TickTock 36:dbd39c315258 243 avg+=bd;
TickTock 36:dbd39c315258 244 if(bd>max) max=bd;
TickTock 36:dbd39c315258 245 if(bd<min) min=bd;
TickTock 36:dbd39c315258 246 }
TickTock 36:dbd39c315258 247 avg /= 96;
TickTock 36:dbd39c315258 248 if(min<3713) {
TickTock 36:dbd39c315258 249 jv=avg-(max-avg)*1.5;
TickTock 36:dbd39c315258 250 } else { // Only compute judgement value if min cellpair meets <= 3712mV requirement
TickTock 36:dbd39c315258 251 jv=0;
TickTock 36:dbd39c315258 252 }
TickTock 36:dbd39c315258 253 tt.cls();
TickTock 36:dbd39c315258 254 tt.locate(0,6);
TickTock 36:dbd39c315258 255 printf(" MAX MIN AVG CVLI T1 T2 T3 T4\n %04d %04d %04d %04d %02dC %02dC %02dC %02dC\n\n",max,min,avg,jv,battData[224+5],battData[224+8],battData[224+11],battData[224+14]);
TickTock 36:dbd39c315258 256 tt.locate(0,36);
TickTock 36:dbd39c315258 257 for(i=0; i<16; i++){
TickTock 36:dbd39c315258 258 printf("%02d-%02d : %04d %04d %04d %04d %04d %04d\n",i*6+1,i*6+6,(battData[i*12+3]<<8)+battData[i*12+4],(battData[i*12+5]<<8)+battData[i*12+6],(battData[i*12+7]<<8)+battData[i*12+8],(battData[i*12+9]<<8)+battData[i*12+10],(battData[i*12+11]<<8)+battData[i*12+12],(battData[i*12+13]<<8)+battData[i*12+14]);
TickTock 36:dbd39c315258 259 }
TickTock 36:dbd39c315258 260 tt.rect(8+0*41,16,40+0*41,28,Green);
TickTock 36:dbd39c315258 261 tt.rect(8+1*41,16,40+1*41,28,Yellow);
TickTock 36:dbd39c315258 262 //tt.rect(8+2*41,16,40+2*41,28,White);
TickTock 36:dbd39c315258 263 tt.rect(8+3*41,16,40+3*41,28,Red);
TickTock 36:dbd39c315258 264 for(i=0; i<96; i++){
TickTock 36:dbd39c315258 265 bd=(battData[i*2+3]<<8)+battData[i*2+4];
TickTock 36:dbd39c315258 266 if(bd>0){
TickTock 36:dbd39c315258 267 if(bd==max) tt.rect(58+(i%6)*41,34+(int)(i/6)*12,90+(i%6)*41,46+(int)(i/6)*12,Green);
TickTock 36:dbd39c315258 268 //if(bd==avg) tt.rect(58+(i%6)*41,34+(int)(i/6)*12,90+(i%6)*41,46+(int)(i/6)*12,White);
TickTock 36:dbd39c315258 269 if(bd==min) tt.rect(58+(i%6)*41,34+(int)(i/6)*12,90+(i%6)*41,46+(int)(i/6)*12,Yellow);
TickTock 36:dbd39c315258 270 if(bd<jv) tt.rect(58+(i%6)*41,34+(int)(i/6)*12,90+(i%6)*41,46+(int)(i/6)*12,Red);
TickTock 36:dbd39c315258 271 }
TickTock 36:dbd39c315258 272 }
TickTock 36:dbd39c315258 273 showCP=false;
TickTock 36:dbd39c315258 274 }
TickTock 36:dbd39c315258 275 if(sMode==1){
TickTock 36:dbd39c315258 276 tt.foreground(Yellow);
TickTock 36:dbd39c315258 277 tt.background(DarkCyan);
TickTock 36:dbd39c315258 278 tt.set_font((unsigned char*) Arial12x12);
TickTock 36:dbd39c315258 279 sprintf(sTemp1,"Request");
TickTock 36:dbd39c315258 280 sprintf(sTemp2,"CP data");
TickTock 36:dbd39c315258 281 showButton(1,0,sTemp1,sTemp2,3,3);
TickTock 36:dbd39c315258 282 }
TickTock 36:dbd39c315258 283 }
TickTock 36:dbd39c315258 284
TickTock 36:dbd39c315258 285 void config1(bool force){
TickTock 36:dbd39c315258 286 if (force) {
TickTock 36:dbd39c315258 287 tt.background(Black);
TickTock 36:dbd39c315258 288 tt.cls();
TickTock 36:dbd39c315258 289 }
TickTock 36:dbd39c315258 290 tt.foreground(Yellow);
TickTock 36:dbd39c315258 291 tt.background(DarkCyan);
TickTock 36:dbd39c315258 292 tt.set_font((unsigned char*) Arial12x12);
TickTock 36:dbd39c315258 293 sprintf(sTemp1," Calibrate");
TickTock 36:dbd39c315258 294 sprintf(sTemp2," Touch");
TickTock 36:dbd39c315258 295 showButton(0,0,sTemp1,sTemp2,3,3);
TickTock 36:dbd39c315258 296 sprintf(sTemp1," Reset");
TickTock 36:dbd39c315258 297 sprintf(sTemp2,"");
TickTock 36:dbd39c315258 298 showButton(1,0,sTemp1,sTemp2,3,3);
TickTock 36:dbd39c315258 299 sprintf(sTemp1," Save");
TickTock 36:dbd39c315258 300 sprintf(sTemp2," Config");
TickTock 36:dbd39c315258 301 showButton(2,0,sTemp1,sTemp2,3,3);
TickTock 36:dbd39c315258 302 if (logEn) {
TickTock 36:dbd39c315258 303 sprintf(sTemp1," Disable");
TickTock 36:dbd39c315258 304 } else {
TickTock 36:dbd39c315258 305 sprintf(sTemp1," Enable");
TickTock 36:dbd39c315258 306 }
TickTock 36:dbd39c315258 307 sprintf(sTemp2," Logging");
TickTock 36:dbd39c315258 308 showButton(0,1,sTemp1,sTemp2,3,3);
TickTock 36:dbd39c315258 309 if (repeatPoll) {
TickTock 36:dbd39c315258 310 sprintf(sTemp1," Disable");
TickTock 36:dbd39c315258 311 } else {
TickTock 36:dbd39c315258 312 sprintf(sTemp1," Enable");
TickTock 36:dbd39c315258 313 }
TickTock 36:dbd39c315258 314 sprintf(sTemp2," Auto CP");
TickTock 36:dbd39c315258 315 showButton(1,1,sTemp1,sTemp2,3,3);
TickTock 36:dbd39c315258 316 sprintf(sTemp1," Start");
TickTock 36:dbd39c315258 317 sprintf(sTemp2,"Playback");
TickTock 36:dbd39c315258 318 showButton(2,1,sTemp1,sTemp2,3,3);
TickTock 36:dbd39c315258 319 }
TickTock 36:dbd39c315258 320
TickTock 36:dbd39c315258 321 void config2(bool force){
TickTock 36:dbd39c315258 322 if (force) {
TickTock 36:dbd39c315258 323 tt.background(Black);
TickTock 36:dbd39c315258 324 tt.cls();
TickTock 36:dbd39c315258 325 }
TickTock 36:dbd39c315258 326 tt.foreground(Yellow);
TickTock 36:dbd39c315258 327 tt.background(DarkCyan);
TickTock 36:dbd39c315258 328 tt.set_font((unsigned char*) Arial12x12);
TickTock 36:dbd39c315258 329 if(playbackOpen){
TickTock 36:dbd39c315258 330 sprintf(sTemp1,"Slower");
TickTock 36:dbd39c315258 331 sprintf(sTemp2," <--");
TickTock 36:dbd39c315258 332 showButton(0,0,sTemp1,sTemp2,3,3);
TickTock 36:dbd39c315258 333 if(playbackEn){
TickTock 36:dbd39c315258 334 sprintf(sTemp1," Pause");
TickTock 36:dbd39c315258 335 }else{
TickTock 36:dbd39c315258 336 sprintf(sTemp1," Run");
TickTock 36:dbd39c315258 337 }
TickTock 36:dbd39c315258 338 sprintf(sTemp2," %4.3f ",playbackInt);
TickTock 36:dbd39c315258 339 showButton(1,0,sTemp1,sTemp2,3,3);
TickTock 36:dbd39c315258 340 sprintf(sTemp1,"Faster");
TickTock 36:dbd39c315258 341 sprintf(sTemp2," -->");
TickTock 36:dbd39c315258 342 showButton(2,0,sTemp1,sTemp2,3,3);
TickTock 36:dbd39c315258 343 }
TickTock 36:dbd39c315258 344 if(playbackOpen){
TickTock 36:dbd39c315258 345 sprintf(sTemp1," Stop");
TickTock 36:dbd39c315258 346 }else{
TickTock 36:dbd39c315258 347 sprintf(sTemp1," Start");
TickTock 36:dbd39c315258 348 }
TickTock 36:dbd39c315258 349 sprintf(sTemp2,"Playback");
TickTock 36:dbd39c315258 350 showButton(1,1,sTemp1,sTemp2,3,3);
TickTock 36:dbd39c315258 351 }
TickTock 36:dbd39c315258 352
TickTock 36:dbd39c315258 353 void showDateTime(bool force){
TickTock 36:dbd39c315258 354 struct tm t; // pointer to a static tm structure
TickTock 36:dbd39c315258 355 time_t seconds ;
TickTock 36:dbd39c315258 356 tt.foreground(Yellow);
TickTock 36:dbd39c315258 357 tt.background(Navy);
TickTock 36:dbd39c315258 358 if (force) {
TickTock 36:dbd39c315258 359 tt.cls();
TickTock 36:dbd39c315258 360 seconds = time(NULL);
TickTock 36:dbd39c315258 361 t = *localtime(&seconds) ;
TickTock 36:dbd39c315258 362
TickTock 36:dbd39c315258 363 tt.locate(10,10);
TickTock 36:dbd39c315258 364 strftime(sTemp1, 32, "%a %m/%d/%Y %X \n", &t);
TickTock 36:dbd39c315258 365 printf("%s",sTemp1);
TickTock 36:dbd39c315258 366 if(sMode==1){
TickTock 36:dbd39c315258 367 tt.foreground(Yellow);
TickTock 36:dbd39c315258 368 tt.background(DarkCyan);
TickTock 36:dbd39c315258 369 tt.set_font((unsigned char*) Arial12x12);
TickTock 36:dbd39c315258 370 sprintf(sTemp2,"");
TickTock 36:dbd39c315258 371 switch(dtMode){
TickTock 36:dbd39c315258 372 case 0:
TickTock 36:dbd39c315258 373 sprintf(sTemp1,"Year");
TickTock 36:dbd39c315258 374 break;
TickTock 36:dbd39c315258 375 case 1:
TickTock 36:dbd39c315258 376 sprintf(sTemp1,"Month");
TickTock 36:dbd39c315258 377 break;
TickTock 36:dbd39c315258 378 case 2:
TickTock 36:dbd39c315258 379 sprintf(sTemp1,"Day");
TickTock 36:dbd39c315258 380 break;
TickTock 36:dbd39c315258 381 case 3:
TickTock 36:dbd39c315258 382 sprintf(sTemp1,"Hour");
TickTock 36:dbd39c315258 383 break;
TickTock 36:dbd39c315258 384 case 4:
TickTock 36:dbd39c315258 385 sprintf(sTemp1,"Minute");
TickTock 36:dbd39c315258 386 break;
TickTock 36:dbd39c315258 387 case 5:
TickTock 36:dbd39c315258 388 sprintf(sTemp1,"Second");
TickTock 36:dbd39c315258 389 break;
TickTock 36:dbd39c315258 390 case 6:
TickTock 36:dbd39c315258 391 sprintf(sTemp1,"Select");
TickTock 36:dbd39c315258 392 break;
TickTock 36:dbd39c315258 393 default:
TickTock 36:dbd39c315258 394 break;
TickTock 36:dbd39c315258 395 }
TickTock 36:dbd39c315258 396 showButton(0,1,sTemp1,sTemp2,3,3);
TickTock 36:dbd39c315258 397 sprintf(sTemp1," UP");
TickTock 36:dbd39c315258 398 showButton(1,1,sTemp1,sTemp2,3,3);
TickTock 36:dbd39c315258 399 sprintf(sTemp1," DOWN");
TickTock 36:dbd39c315258 400 showButton(2,1,sTemp1,sTemp2,3,3);
TickTock 36:dbd39c315258 401 }
TickTock 36:dbd39c315258 402 }
TickTock 36:dbd39c315258 403 }
TickTock 36:dbd39c315258 404
TickTock 37:fea2c1d52c5f 405 void test(bool force){
TickTock 37:fea2c1d52c5f 406 unsigned char left,right;
TickTock 37:fea2c1d52c5f 407 CANMessage msg;
TickTock 37:fea2c1d52c5f 408 static unsigned char lleft=0;
TickTock 37:fea2c1d52c5f 409
TickTock 37:fea2c1d52c5f 410 msg = lastMsg[indexLastMsg[0x284]];
TickTock 37:fea2c1d52c5f 411 right = msg.data[7];
TickTock 37:fea2c1d52c5f 412 msg = lastMsg[indexLastMsg[0x280]];
TickTock 37:fea2c1d52c5f 413 left = msg.data[6];
TickTock 37:fea2c1d52c5f 414
TickTock 37:fea2c1d52c5f 415 tt.background(Navy);
TickTock 37:fea2c1d52c5f 416 if(force) tt.cls();
TickTock 37:fea2c1d52c5f 417 if(force||left!=lleft){
TickTock 37:fea2c1d52c5f 418 tt.foreground(Yellow);
TickTock 37:fea2c1d52c5f 419 tt.set_font((unsigned char*) Arial28x28);
TickTock 37:fea2c1d52c5f 420 tt.locate(10,200);
TickTock 37:fea2c1d52c5f 421 printf("%d \n",left);
TickTock 37:fea2c1d52c5f 422 tt.locate(200,200);
TickTock 37:fea2c1d52c5f 423 printf("%d \n",right);
TickTock 37:fea2c1d52c5f 424 lleft=left;
TickTock 37:fea2c1d52c5f 425 }
TickTock 37:fea2c1d52c5f 426 }
TickTock 37:fea2c1d52c5f 427
TickTock 36:dbd39c315258 428 void updateDisplay(char display){
TickTock 36:dbd39c315258 429 bool changed;
TickTock 36:dbd39c315258 430 changed = dMode[display]!=lastDMode[display];
TickTock 36:dbd39c315258 431 tt.set_display(display);
TickTock 36:dbd39c315258 432 switch (dMode[display]) {
TickTock 36:dbd39c315258 433 case logScreen:
TickTock 36:dbd39c315258 434 printLog(changed);
TickTock 36:dbd39c315258 435 break;
TickTock 36:dbd39c315258 436 case dteScreen:
TickTock 36:dbd39c315258 437 printDTE(changed);
TickTock 36:dbd39c315258 438 break;
TickTock 36:dbd39c315258 439 case brakeScreen:
TickTock 36:dbd39c315258 440 braking(changed);
TickTock 36:dbd39c315258 441 break;
TickTock 37:fea2c1d52c5f 442 case testScreen:
TickTock 37:fea2c1d52c5f 443 test(changed);
TickTock 37:fea2c1d52c5f 444 break;
TickTock 36:dbd39c315258 445 case monitorScreen:
TickTock 36:dbd39c315258 446 printLast(changed);
TickTock 36:dbd39c315258 447 break;
TickTock 36:dbd39c315258 448 case changedScreen:
TickTock 36:dbd39c315258 449 printChanged(changed);
TickTock 36:dbd39c315258 450 break;
TickTock 36:dbd39c315258 451 case cpScreen:
TickTock 36:dbd39c315258 452 cpData(changed||showCP);
TickTock 36:dbd39c315258 453 break;
TickTock 36:dbd39c315258 454 case config1Screen:
TickTock 36:dbd39c315258 455 config1(changed);
TickTock 36:dbd39c315258 456 break;
TickTock 38:155ec32c5e91 457 case playbackScreen:
TickTock 36:dbd39c315258 458 config2(changed);
TickTock 36:dbd39c315258 459 break;
TickTock 36:dbd39c315258 460 case dateScreen:
TickTock 36:dbd39c315258 461 showDateTime(changed);
TickTock 36:dbd39c315258 462 break;
TickTock 36:dbd39c315258 463 default:
TickTock 36:dbd39c315258 464 tt.background(Black);
TickTock 36:dbd39c315258 465 tt.cls();
TickTock 36:dbd39c315258 466 break;
TickTock 36:dbd39c315258 467 }
TickTock 36:dbd39c315258 468 lastDMode[display]=dMode[display];
TickTock 36:dbd39c315258 469
TickTock 36:dbd39c315258 470 switch (sMode) {
TickTock 36:dbd39c315258 471 case 1: // Select screens
TickTock 36:dbd39c315258 472 tt.foreground(Yellow);
TickTock 36:dbd39c315258 473 tt.background(DarkCyan);
TickTock 36:dbd39c315258 474 tt.set_font((unsigned char*) Arial12x12);
TickTock 36:dbd39c315258 475 sprintf(sTemp1,"<-Prev");
TickTock 36:dbd39c315258 476 sprintf(sTemp2,"");
TickTock 36:dbd39c315258 477 showButton(0,2,sTemp1,sTemp2,3,3);
TickTock 36:dbd39c315258 478 sprintf(sTemp1," Select %d",dMode[display]);
TickTock 36:dbd39c315258 479 showButton(1,2,sTemp1,sTemp2,3,3);
TickTock 36:dbd39c315258 480 sprintf(sTemp1," Next->");
TickTock 36:dbd39c315258 481 showButton(2,2,sTemp1,sTemp2,3,3);
TickTock 36:dbd39c315258 482 break;
TickTock 36:dbd39c315258 483 case 2: // numpad
TickTock 36:dbd39c315258 484 sprintf(sTemp2,"");
TickTock 36:dbd39c315258 485 tt.foreground(Yellow);
TickTock 36:dbd39c315258 486 tt.background(DarkCyan);
TickTock 36:dbd39c315258 487 tt.set_font((unsigned char*) Arial24x23);
TickTock 36:dbd39c315258 488 sprintf(sTemp1," 1");
TickTock 36:dbd39c315258 489 showButton(0,0,sTemp1,sTemp2,4,4);
TickTock 36:dbd39c315258 490 sprintf(sTemp1," 2");
TickTock 36:dbd39c315258 491 showButton(1,0,sTemp1,sTemp2,4,4);
TickTock 36:dbd39c315258 492 sprintf(sTemp1," 3");
TickTock 36:dbd39c315258 493 showButton(2,0,sTemp1,sTemp2,4,4);
TickTock 36:dbd39c315258 494 sprintf(sTemp1," 4");
TickTock 36:dbd39c315258 495 showButton(0,1,sTemp1,sTemp2,4,4);
TickTock 36:dbd39c315258 496 sprintf(sTemp1," 5");
TickTock 36:dbd39c315258 497 showButton(1,1,sTemp1,sTemp2,4,4);
TickTock 36:dbd39c315258 498 sprintf(sTemp1," 6");
TickTock 36:dbd39c315258 499 showButton(2,1,sTemp1,sTemp2,4,4);
TickTock 36:dbd39c315258 500 sprintf(sTemp1," 7");
TickTock 36:dbd39c315258 501 showButton(0,2,sTemp1,sTemp2,4,4);
TickTock 36:dbd39c315258 502 sprintf(sTemp1," 8");
TickTock 36:dbd39c315258 503 showButton(1,2,sTemp1,sTemp2,4,4);
TickTock 36:dbd39c315258 504 sprintf(sTemp1," 9");
TickTock 36:dbd39c315258 505 showButton(2,2,sTemp1,sTemp2,4,4);
TickTock 36:dbd39c315258 506 sprintf(sTemp1," 0");
TickTock 36:dbd39c315258 507 showButton(1,3,sTemp1,sTemp2,4,4);
TickTock 36:dbd39c315258 508 sprintf(sTemp1,"<--");
TickTock 36:dbd39c315258 509 showButton(0,3,sTemp1,sTemp2,4,4);
TickTock 36:dbd39c315258 510 sprintf(sTemp1,"-->");
TickTock 36:dbd39c315258 511 showButton(2,3,sTemp1,sTemp2,4,4);
TickTock 36:dbd39c315258 512 sprintf(sTemp1,"return");
TickTock 36:dbd39c315258 513 showButton(3,3,sTemp1,sTemp2,4,4);
TickTock 36:dbd39c315258 514 case 3:
TickTock 36:dbd39c315258 515 break;
TickTock 36:dbd39c315258 516 default:
TickTock 36:dbd39c315258 517 break;
TickTock 36:dbd39c315258 518 }
TickTock 36:dbd39c315258 519 }
TickTock 36:dbd39c315258 520
TickTock 36:dbd39c315258 521 void showButton(unsigned char column, unsigned char row, char * text1, char * text2, unsigned char columns, unsigned char rows){
TickTock 36:dbd39c315258 522 unsigned short x1,x2,y1,y2;
TickTock 36:dbd39c315258 523 x1=column*(320/columns)+btnGap/2;
TickTock 36:dbd39c315258 524 x2=(column+1)*(320/columns)-btnGap/2;
TickTock 36:dbd39c315258 525 y1=row*(240/rows)+btnGap/2;
TickTock 36:dbd39c315258 526 y2=(row+1)*(240/rows)-btnGap/2;
TickTock 36:dbd39c315258 527 tt.fillrect(x1,y1,x2,y2,DarkCyan);
TickTock 36:dbd39c315258 528 tt.locate(x1+btnGap,y1+btnGap);
TickTock 36:dbd39c315258 529 printf("%s\n",text1);
TickTock 36:dbd39c315258 530 tt.locate(x1+btnGap,y1+btnGap+30);
TickTock 36:dbd39c315258 531 printf("%s\n",text2);
TickTock 36:dbd39c315258 532 }
TickTock 36:dbd39c315258 533
TickTock 28:f24ac05645d9 534 /*void braking (bool force, bool prdata=false){
TickTock 23:cd03f9c3395e 535 unsigned long targetBraking, regenBraking, speed;
TickTock 27:6bd073c33977 536 static unsigned long maxTarget = 20000, maxRegen = 20000, tarDivReg = 1000;
TickTock 13:62e0f7f39ff5 537 short rpm;
TickTock 13:62e0f7f39ff5 538 unsigned long temp;
TickTock 13:62e0f7f39ff5 539 static unsigned char lastPressure[4] = {200,200,200,200};
TickTock 13:62e0f7f39ff5 540 unsigned char i,r,t;
TickTock 13:62e0f7f39ff5 541 static unsigned char lr, lt;
TickTock 13:62e0f7f39ff5 542 CANMessage msg;
TickTock 13:62e0f7f39ff5 543
TickTock 13:62e0f7f39ff5 544 msg = lastMsg[indexLastMsg[0x1cb]]; //Get Target and Regen
TickTock 13:62e0f7f39ff5 545 regenBraking = (msg.data[0]<<3)+(msg.data[1]>>5);
TickTock 13:62e0f7f39ff5 546 targetBraking = (msg.data[2]<<3)+(msg.data[3]>>5);
TickTock 13:62e0f7f39ff5 547 msg = lastMsg[indexLastMsg[0x176]]; //Get rpms - not sure what this is but scales to mph with .0725
TickTock 13:62e0f7f39ff5 548 rpm = ((short)msg.data[0]<<8)+msg.data[1];
TickTock 13:62e0f7f39ff5 549 speed =rpm>0?rpm>>3:-rpm>>3; //Take absolute to get speed; div8
TickTock 23:cd03f9c3395e 550 if ((targetBraking>2039)||(speed>200)) { //Filter weird messages
TickTock 23:cd03f9c3395e 551 targetBraking = 0;
TickTock 23:cd03f9c3395e 552 regenBraking = 0;
TickTock 23:cd03f9c3395e 553 } else {
TickTock 23:cd03f9c3395e 554 if ((targetBraking>50)&&(regenBraking>50)){
TickTock 23:cd03f9c3395e 555 temp = targetBraking;
TickTock 23:cd03f9c3395e 556 temp *= 1000;
TickTock 23:cd03f9c3395e 557 temp /= regenBraking;
TickTock 23:cd03f9c3395e 558 if (temp<tarDivReg) tarDivReg=temp;
TickTock 23:cd03f9c3395e 559 }
TickTock 23:cd03f9c3395e 560 targetBraking *= speed;
TickTock 23:cd03f9c3395e 561 regenBraking *= speed;
TickTock 23:cd03f9c3395e 562 if (targetBraking>maxTarget) maxTarget=targetBraking;
TickTock 23:cd03f9c3395e 563 if (regenBraking>maxRegen) maxRegen=regenBraking;
TickTock 23:cd03f9c3395e 564 }
TickTock 23:cd03f9c3395e 565
TickTock 13:62e0f7f39ff5 566 msg = lastMsg[indexLastMsg[0x1ca]]; //Get brake pressure
TickTock 13:62e0f7f39ff5 567 tt.background(Navy);
TickTock 13:62e0f7f39ff5 568 if (force) {
TickTock 13:62e0f7f39ff5 569 tt.cls();
TickTock 13:62e0f7f39ff5 570 tt.rect(0,111,170,239,White);
TickTock 13:62e0f7f39ff5 571 tt.line(0,207,170,207,White);
TickTock 13:62e0f7f39ff5 572 tt.line(0,175,170,175,White);
TickTock 13:62e0f7f39ff5 573 tt.line(0,143,170,143,White);
TickTock 13:62e0f7f39ff5 574 lastPressure[0] = 200;
TickTock 13:62e0f7f39ff5 575 lastPressure[1] = 200;
TickTock 13:62e0f7f39ff5 576 lastPressure[2] = 200;
TickTock 13:62e0f7f39ff5 577 lastPressure[3] = 200;
TickTock 13:62e0f7f39ff5 578 }
TickTock 13:62e0f7f39ff5 579 // plot bar graph for each wheel pressure
TickTock 13:62e0f7f39ff5 580 for (i=0; i<4; i++){
TickTock 13:62e0f7f39ff5 581 if (msg.data[i]<239) {
TickTock 13:62e0f7f39ff5 582 if (msg.data[i]>lastPressure[i]){
TickTock 13:62e0f7f39ff5 583 tt.fillrect(10+40*i,239-msg.data[i],40+40*i,239,Red);
TickTock 13:62e0f7f39ff5 584 } else if (msg.data[i]<lastPressure[i]) {
TickTock 13:62e0f7f39ff5 585 tt.fillrect(10+40*i,238-lastPressure[i],40+40*i,238-msg.data[i],Navy);
TickTock 13:62e0f7f39ff5 586 }
TickTock 13:62e0f7f39ff5 587 lastPressure[i]=msg.data[i];
TickTock 13:62e0f7f39ff5 588 }
TickTock 13:62e0f7f39ff5 589 }
TickTock 13:62e0f7f39ff5 590
TickTock 27:6bd073c33977 591 temp = targetBraking;
TickTock 27:6bd073c33977 592 temp *=200;
TickTock 27:6bd073c33977 593 temp /= maxTarget;
TickTock 27:6bd073c33977 594 t = (char) temp;
TickTock 27:6bd073c33977 595 if (t>200) t=200;
TickTock 27:6bd073c33977 596 temp = regenBraking;
TickTock 27:6bd073c33977 597 temp *= tarDivReg;
TickTock 27:6bd073c33977 598 temp /= maxTarget;
TickTock 27:6bd073c33977 599 temp /= 5;
TickTock 27:6bd073c33977 600 r = (char) temp;
TickTock 27:6bd073c33977 601 if (r>200) r=200;
TickTock 27:6bd073c33977 602 if(lr!=r&&prdata){
TickTock 27:6bd073c33977 603 tt.foreground(Yellow);
TickTock 27:6bd073c33977 604 tt.set_font((unsigned char*) Arial28x28);
TickTock 27:6bd073c33977 605 tt.locate(100,40);
TickTock 27:6bd073c33977 606 printf("%d %d \n",regenBraking,maxRegen);
TickTock 27:6bd073c33977 607 tt.locate(100,70);
TickTock 27:6bd073c33977 608 printf("%3.1f (%3.1f%s) \n",(float)tarDivReg/10,(float)regenBraking*tarDivReg/targetBraking/10,"%");
TickTock 27:6bd073c33977 609 }
TickTock 27:6bd073c33977 610 if(lt!=t&&prdata){
TickTock 27:6bd073c33977 611 tt.foreground(Yellow);
TickTock 27:6bd073c33977 612 tt.set_font((unsigned char*) Arial28x28);
TickTock 27:6bd073c33977 613 tt.locate(100,10);
TickTock 27:6bd073c33977 614 printf("%d %d \n",targetBraking,maxTarget);
TickTock 13:62e0f7f39ff5 615 }
TickTock 27:6bd073c33977 616 if (r>t) t=r; //Should never happen
TickTock 27:6bd073c33977 617 if((lr!=r||lt!=t)&&!prdata){
TickTock 27:6bd073c33977 618 tt.fillrect(200,10,300,239-t,Navy);
TickTock 27:6bd073c33977 619 tt.fillrect(200,239-t,300,239-r,Red);
TickTock 27:6bd073c33977 620 tt.fillrect(200,239-r,300,239,Green);
TickTock 27:6bd073c33977 621 }
TickTock 27:6bd073c33977 622 lt=t;
TickTock 27:6bd073c33977 623 lr=r;
TickTock 36:dbd39c315258 624 }*/