Tick Tock / Mbed 2 deprecated CANary_9341_test

test fork

Dependencies:   SPI_TFTx2 SPI_TFTx2_ILI9341 TFT_fonts TOUCH_TFTx2 mbed

Fork of CANary_9341 by Tick Tock

displayModes.cpp@40:0e6e71a7323f, 2013-03-31 (annotated)

Committer:
TickTock
Date:
Sun Mar 31 17:45:05 2013 +0000
Revision:
40:0e6e71a7323f
Parent:
39:eef8beac7411
Child:
41:8d4609ea7259
eliminated flicker on 12V display;

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