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@44:6262a9fd1e56, 2013-04-02 (annotated)

Committer:
TickTock
Date:
Tue Apr 02 06:53:50 2013 +0000
Revision:
44:6262a9fd1e56
Parent:
43:e7f6f80590e3
Child:
47:9cc7d876dd6d
Added CP histogram

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 42:4533b13b297d 7 void printLast (bool force, bool showButtons){
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 42:4533b13b297d 18 if((sMode==1)&&showButtons){
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 42:4533b13b297d 30 void printChanged (bool force, bool showButtons){
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 42:4533b13b297d 48 if((sMode==1)&&showButtons){
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 44:6262a9fd1e56 55 sprintf(sTemp1," <down>");
TickTock 44:6262a9fd1e56 56 showButton(2,0,sTemp1,sTemp2,3,3);
TickTock 44:6262a9fd1e56 57 sprintf(sTemp1," Reset");
TickTock 44:6262a9fd1e56 58 sprintf(sTemp2," Baseline");
TickTock 40:0e6e71a7323f 59 showButton(1,0,sTemp1,sTemp2,3,3);
TickTock 40:0e6e71a7323f 60 }
TickTock 13:62e0f7f39ff5 61 }
TickTock 13:62e0f7f39ff5 62
TickTock 42:4533b13b297d 63 void printLog (bool force, bool showButtons){
TickTock 13:62e0f7f39ff5 64 static unsigned char lastDisplayLoc = 0;
TickTock 13:62e0f7f39ff5 65 if(force||displayLoc!=lastDisplayLoc){ //only update if changed
TickTock 13:62e0f7f39ff5 66 tt.foreground(Amber);
TickTock 13:62e0f7f39ff5 67 tt.background(Black);
TickTock 13:62e0f7f39ff5 68 tt.cls();
TickTock 13:62e0f7f39ff5 69 tt.locate(0,6);
TickTock 13:62e0f7f39ff5 70 tt.set_font((unsigned char*) Arial12x12);
TickTock 13:62e0f7f39ff5 71 for(int i=0; i<19; i++){
TickTock 13:62e0f7f39ff5 72 printf("%s",displayLog[displayLoc]);
TickTock 13:62e0f7f39ff5 73 displayLoc=displayLoc>17?0:displayLoc+1;
TickTock 13:62e0f7f39ff5 74 }
TickTock 13:62e0f7f39ff5 75 }
TickTock 13:62e0f7f39ff5 76 lastDisplayLoc=displayLoc;
TickTock 13:62e0f7f39ff5 77 }
TickTock 13:62e0f7f39ff5 78
TickTock 42:4533b13b297d 79 void mainDisplay (bool force, bool showButtons){
TickTock 13:62e0f7f39ff5 80 unsigned short gids, SOC, packV;
TickTock 13:62e0f7f39ff5 81 static unsigned short lgids=0, lSOC=0, lpackV=0;
TickTock 44:6262a9fd1e56 82 static float lkW=0, laccV=0;;
TickTock 13:62e0f7f39ff5 83 CANMessage msg;
TickTock 13:62e0f7f39ff5 84
TickTock 13:62e0f7f39ff5 85 msg = lastMsg[indexLastMsg[0x5bc]]; //Get gids
TickTock 13:62e0f7f39ff5 86 gids = (msg.data[0]<<2)+(msg.data[1]>>6);
TickTock 13:62e0f7f39ff5 87 msg = lastMsg[indexLastMsg[0x55b]]; //Get SOC
TickTock 13:62e0f7f39ff5 88 SOC = (msg.data[0]<<2)+(msg.data[1]>>6);
TickTock 13:62e0f7f39ff5 89 msg = lastMsg[indexLastMsg[0x1db]]; //Get pack volts
TickTock 13:62e0f7f39ff5 90 packV = (msg.data[2]<<2)+(msg.data[3]>>6);
TickTock 13:62e0f7f39ff5 91
TickTock 13:62e0f7f39ff5 92 tt.background(Navy);
TickTock 38:155ec32c5e91 93 tt.foreground(Yellow);
TickTock 38:155ec32c5e91 94 tt.set_font((unsigned char*) Arial28x28);
TickTock 13:62e0f7f39ff5 95 if(force) tt.cls();
TickTock 13:62e0f7f39ff5 96 if(force||gids!=lgids){
TickTock 13:62e0f7f39ff5 97 tt.locate(10,10);
TickTock 44:6262a9fd1e56 98 printf("%4d gids \n",gids);
TickTock 35:5acbd8a64a89 99 tt.locate(20,40);
TickTock 44:6262a9fd1e56 100 printf("%4.1f kWh \n",(float)gids*0.08);
TickTock 13:62e0f7f39ff5 101 tt.set_font((unsigned char*) SCProSB31x55);
TickTock 13:62e0f7f39ff5 102 tt.foreground(Green);
TickTock 13:62e0f7f39ff5 103 tt.locate(60,96);
TickTock 34:4751a8259b18 104 printf("%4.1f mi \n",(float)(gids-5)*0.31); // Approx for now
TickTock 13:62e0f7f39ff5 105 lgids=gids;
TickTock 38:155ec32c5e91 106 tt.foreground(Yellow);
TickTock 38:155ec32c5e91 107 tt.set_font((unsigned char*) Arial28x28);
TickTock 13:62e0f7f39ff5 108 }
TickTock 13:62e0f7f39ff5 109 if(force||SOC!=lSOC){
TickTock 13:62e0f7f39ff5 110 tt.locate(200,10);
TickTock 44:6262a9fd1e56 111 printf("%4.1f%s\n",(float)SOC/10,"% ");
TickTock 13:62e0f7f39ff5 112 lSOC=SOC;
TickTock 13:62e0f7f39ff5 113 }
TickTock 13:62e0f7f39ff5 114 if(force||packV!=lpackV){
TickTock 13:62e0f7f39ff5 115 tt.locate(200,200);
TickTock 37:fea2c1d52c5f 116 printf("%4.1fV \n",(float)packV/2);
TickTock 13:62e0f7f39ff5 117 lpackV=packV;
TickTock 13:62e0f7f39ff5 118 }
TickTock 39:eef8beac7411 119 if(force||accV!=laccV){
TickTock 35:5acbd8a64a89 120 tt.locate(20,200);
TickTock 40:0e6e71a7323f 121 printf("%3.1fV \n",accV);
TickTock 40:0e6e71a7323f 122 laccV=accV;
TickTock 38:155ec32c5e91 123 }
TickTock 44:6262a9fd1e56 124 if(force||kW!=lkW){
TickTock 38:155ec32c5e91 125 tt.locate(180,40);
TickTock 44:6262a9fd1e56 126 printf("%3.2fkW \n",kW);
TickTock 44:6262a9fd1e56 127 lkW=kW;
TickTock 35:5acbd8a64a89 128 }
TickTock 13:62e0f7f39ff5 129 }
TickTock 13:62e0f7f39ff5 130
TickTock 42:4533b13b297d 131 void braking (bool force, bool showButtons, bool prdata=false){
TickTock 28:f24ac05645d9 132 unsigned long targetBraking, regenBraking;
TickTock 28:f24ac05645d9 133 static unsigned long maxTarget = 1000, maxRegen = 1000, tarDivReg = 1000;
TickTock 28:f24ac05645d9 134 unsigned long temp;
TickTock 28:f24ac05645d9 135 static unsigned char lastPressure[4] = {200,200,200,200};
TickTock 28:f24ac05645d9 136 unsigned char i,r,t;
TickTock 37:fea2c1d52c5f 137 static unsigned char lr=0, lt=0;
TickTock 37:fea2c1d52c5f 138 signed short steering;
TickTock 37:fea2c1d52c5f 139 unsigned short s;
TickTock 37:fea2c1d52c5f 140 static unsigned short ls;
TickTock 37:fea2c1d52c5f 141 unsigned char throttle;
TickTock 37:fea2c1d52c5f 142 static unsigned char lthrottle;
TickTock 28:f24ac05645d9 143 CANMessage msg;
TickTock 28:f24ac05645d9 144
TickTock 37:fea2c1d52c5f 145 msg = lastMsg[indexLastMsg[0x180]]; //Get Throttle position
TickTock 37:fea2c1d52c5f 146 throttle = msg.data[5];
TickTock 37:fea2c1d52c5f 147 msg = lastMsg[indexLastMsg[0x002]]; //Get Steering angle
TickTock 37:fea2c1d52c5f 148 steering = (msg.data[1]<<8)+msg.data[0];
TickTock 37:fea2c1d52c5f 149 s= (unsigned short) ((steering/10)+160)%310;
TickTock 28:f24ac05645d9 150 msg = lastMsg[indexLastMsg[0x1cb]]; //Get Target and Regen
TickTock 28:f24ac05645d9 151 regenBraking = (msg.data[0]<<3)+(msg.data[1]>>5);
TickTock 28:f24ac05645d9 152 targetBraking = (msg.data[2]<<3)+(msg.data[3]>>5);
TickTock 28:f24ac05645d9 153 if ((targetBraking>50)&&(regenBraking>50)){
TickTock 28:f24ac05645d9 154 temp = targetBraking;
TickTock 28:f24ac05645d9 155 temp *= 1000;
TickTock 28:f24ac05645d9 156 temp /= regenBraking;
TickTock 28:f24ac05645d9 157 if (temp<tarDivReg) tarDivReg=temp;
TickTock 28:f24ac05645d9 158 }
TickTock 28:f24ac05645d9 159 if (targetBraking>maxTarget) maxTarget=targetBraking;
TickTock 28:f24ac05645d9 160 if (regenBraking>maxRegen) maxRegen=regenBraking;
TickTock 28:f24ac05645d9 161
TickTock 28:f24ac05645d9 162 msg = lastMsg[indexLastMsg[0x1ca]]; //Get brake pressure
TickTock 28:f24ac05645d9 163 tt.background(Navy);
TickTock 28:f24ac05645d9 164 if (force) {
TickTock 28:f24ac05645d9 165 tt.cls();
TickTock 28:f24ac05645d9 166 tt.rect(0,111,170,239,White);
TickTock 28:f24ac05645d9 167 tt.line(0,207,170,207,White);
TickTock 28:f24ac05645d9 168 tt.line(0,175,170,175,White);
TickTock 28:f24ac05645d9 169 tt.line(0,143,170,143,White);
TickTock 28:f24ac05645d9 170 lastPressure[0] = 200;
TickTock 28:f24ac05645d9 171 lastPressure[1] = 200;
TickTock 28:f24ac05645d9 172 lastPressure[2] = 200;
TickTock 28:f24ac05645d9 173 lastPressure[3] = 200;
TickTock 28:f24ac05645d9 174 }
TickTock 37:fea2c1d52c5f 175
TickTock 37:fea2c1d52c5f 176 if (s!=ls){
TickTock 37:fea2c1d52c5f 177 tt.fillrect(ls,5,ls+9,14, Navy);
TickTock 37:fea2c1d52c5f 178 tt.fillrect(s,5,s+9,14, White);
TickTock 37:fea2c1d52c5f 179 //tt.foreground(Yellow);
TickTock 37:fea2c1d52c5f 180 //tt.set_font((unsigned char*) Arial28x28);
TickTock 37:fea2c1d52c5f 181 //tt.locate(10,40);
TickTock 37:fea2c1d52c5f 182 //printf("%d %d \n",s,ls);
TickTock 37:fea2c1d52c5f 183 ls=s;
TickTock 37:fea2c1d52c5f 184 }
TickTock 37:fea2c1d52c5f 185 if (throttle!=lthrottle){
TickTock 37:fea2c1d52c5f 186 if (throttle>239) throttle=239;
TickTock 37:fea2c1d52c5f 187 if(throttle<lthrottle){
TickTock 37:fea2c1d52c5f 188 tt.fillrect(280,239-lthrottle,310,239-throttle,Navy);
TickTock 37:fea2c1d52c5f 189 }else{
TickTock 37:fea2c1d52c5f 190 tt.fillrect(280,239-throttle,310,239,Yellow);
TickTock 37:fea2c1d52c5f 191 }
TickTock 37:fea2c1d52c5f 192 lthrottle=throttle;
TickTock 37:fea2c1d52c5f 193 }
TickTock 37:fea2c1d52c5f 194
TickTock 28:f24ac05645d9 195 // plot bar graph for each wheel pressure
TickTock 28:f24ac05645d9 196 for (i=0; i<4; i++){
TickTock 28:f24ac05645d9 197 if (msg.data[i]<239) {
TickTock 28:f24ac05645d9 198 if (msg.data[i]>lastPressure[i]){
TickTock 28:f24ac05645d9 199 tt.fillrect(10+40*i,239-msg.data[i],40+40*i,239,Red);
TickTock 28:f24ac05645d9 200 } else if (msg.data[i]<lastPressure[i]) {
TickTock 28:f24ac05645d9 201 tt.fillrect(10+40*i,238-lastPressure[i],40+40*i,238-msg.data[i],Navy);
TickTock 28:f24ac05645d9 202 }
TickTock 28:f24ac05645d9 203 lastPressure[i]=msg.data[i];
TickTock 28:f24ac05645d9 204 }
TickTock 28:f24ac05645d9 205 }
TickTock 28:f24ac05645d9 206
TickTock 28:f24ac05645d9 207 temp = targetBraking;
TickTock 28:f24ac05645d9 208 temp *=200;
TickTock 28:f24ac05645d9 209 temp /= maxTarget;
TickTock 28:f24ac05645d9 210 t = (char) temp;
TickTock 28:f24ac05645d9 211 if (t>200) t=200;
TickTock 28:f24ac05645d9 212 temp = regenBraking;
TickTock 28:f24ac05645d9 213 temp *= tarDivReg;
TickTock 28:f24ac05645d9 214 temp /= maxTarget;
TickTock 28:f24ac05645d9 215 temp /= 5;
TickTock 28:f24ac05645d9 216 r = (char) temp;
TickTock 28:f24ac05645d9 217 if (r>200) r=200;
TickTock 28:f24ac05645d9 218 if(lr!=r&&prdata){
TickTock 28:f24ac05645d9 219 tt.foreground(Yellow);
TickTock 28:f24ac05645d9 220 tt.set_font((unsigned char*) Arial28x28);
TickTock 28:f24ac05645d9 221 tt.locate(100,40);
TickTock 28:f24ac05645d9 222 printf("%d %d \n",regenBraking,maxRegen);
TickTock 28:f24ac05645d9 223 tt.locate(100,70);
TickTock 28:f24ac05645d9 224 printf("%3.1f (%3.1f%s) \n",(float)tarDivReg/10,(float)regenBraking*tarDivReg/targetBraking/10,"%");
TickTock 28:f24ac05645d9 225 }
TickTock 28:f24ac05645d9 226 if(lt!=t&&prdata){
TickTock 28:f24ac05645d9 227 tt.foreground(Yellow);
TickTock 28:f24ac05645d9 228 tt.set_font((unsigned char*) Arial28x28);
TickTock 28:f24ac05645d9 229 tt.locate(100,10);
TickTock 28:f24ac05645d9 230 printf("%d %d \n",targetBraking,maxTarget);
TickTock 28:f24ac05645d9 231 }
TickTock 28:f24ac05645d9 232 if (r>t) t=r; //Should never happen
TickTock 28:f24ac05645d9 233 if((lr!=r||lt!=t)&&!prdata){
TickTock 37:fea2c1d52c5f 234 tt.fillrect(190,10,260,239-t,Navy);
TickTock 37:fea2c1d52c5f 235 tt.fillrect(190,239-t,260,239-r,Red);
TickTock 37:fea2c1d52c5f 236 tt.fillrect(190,239-r,260,239,Green);
TickTock 28:f24ac05645d9 237 }
TickTock 28:f24ac05645d9 238 lt=t;
TickTock 28:f24ac05645d9 239 lr=r;
TickTock 28:f24ac05645d9 240 }
TickTock 28:f24ac05645d9 241
TickTock 42:4533b13b297d 242 void cpData(bool force, bool showButtons){
TickTock 36:dbd39c315258 243 short unsigned max, min, jv, i, bd;
TickTock 36:dbd39c315258 244 unsigned avg;
TickTock 36:dbd39c315258 245 if(force){
TickTock 36:dbd39c315258 246 tt.foreground(White);
TickTock 36:dbd39c315258 247 tt.background(Navy);
TickTock 36:dbd39c315258 248 tt.set_font((unsigned char*) Arial12x12_prop); // select the font
TickTock 36:dbd39c315258 249 max=0;
TickTock 36:dbd39c315258 250 min=9999;
TickTock 36:dbd39c315258 251 avg=0;
TickTock 36:dbd39c315258 252 for(i=0; i<96; i++){
TickTock 36:dbd39c315258 253 bd=(battData[i*2+3]<<8)+battData[i*2+4];
TickTock 36:dbd39c315258 254 avg+=bd;
TickTock 36:dbd39c315258 255 if(bd>max) max=bd;
TickTock 36:dbd39c315258 256 if(bd<min) min=bd;
TickTock 36:dbd39c315258 257 }
TickTock 36:dbd39c315258 258 avg /= 96;
TickTock 36:dbd39c315258 259 if(min<3713) {
TickTock 36:dbd39c315258 260 jv=avg-(max-avg)*1.5;
TickTock 36:dbd39c315258 261 } else { // Only compute judgement value if min cellpair meets <= 3712mV requirement
TickTock 36:dbd39c315258 262 jv=0;
TickTock 36:dbd39c315258 263 }
TickTock 36:dbd39c315258 264 tt.cls();
TickTock 36:dbd39c315258 265 tt.locate(0,6);
TickTock 36:dbd39c315258 266 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 267 tt.locate(0,36);
TickTock 36:dbd39c315258 268 for(i=0; i<16; i++){
TickTock 36:dbd39c315258 269 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 270 }
TickTock 36:dbd39c315258 271 tt.rect(8+0*41,16,40+0*41,28,Green);
TickTock 36:dbd39c315258 272 tt.rect(8+1*41,16,40+1*41,28,Yellow);
TickTock 36:dbd39c315258 273 //tt.rect(8+2*41,16,40+2*41,28,White);
TickTock 36:dbd39c315258 274 tt.rect(8+3*41,16,40+3*41,28,Red);
TickTock 36:dbd39c315258 275 for(i=0; i<96; i++){
TickTock 36:dbd39c315258 276 bd=(battData[i*2+3]<<8)+battData[i*2+4];
TickTock 36:dbd39c315258 277 if(bd>0){
TickTock 36:dbd39c315258 278 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 279 //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 280 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 281 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 282 }
TickTock 36:dbd39c315258 283 }
TickTock 36:dbd39c315258 284 showCP=false;
TickTock 36:dbd39c315258 285 }
TickTock 42:4533b13b297d 286 if((sMode==1)&&showButtons){
TickTock 36:dbd39c315258 287 tt.foreground(Yellow);
TickTock 36:dbd39c315258 288 tt.background(DarkCyan);
TickTock 36:dbd39c315258 289 tt.set_font((unsigned char*) Arial12x12);
TickTock 44:6262a9fd1e56 290 sprintf(sTemp1," Request");
TickTock 44:6262a9fd1e56 291 sprintf(sTemp2," CP data");
TickTock 44:6262a9fd1e56 292 showButton(1,0,sTemp1,sTemp2,3,3);
TickTock 44:6262a9fd1e56 293 }
TickTock 44:6262a9fd1e56 294 }
TickTock 44:6262a9fd1e56 295
TickTock 44:6262a9fd1e56 296 //----------------
TickTock 44:6262a9fd1e56 297 // gg - hist
TickTock 44:6262a9fd1e56 298 void cpHistogram(bool force){
TickTock 44:6262a9fd1e56 299 short unsigned max, min, jv, i, bd;
TickTock 44:6262a9fd1e56 300 unsigned avg;
TickTock 44:6262a9fd1e56 301 if(force){
TickTock 44:6262a9fd1e56 302 tt.foreground(White);
TickTock 44:6262a9fd1e56 303 tt.background(Navy);
TickTock 44:6262a9fd1e56 304 tt.set_font((unsigned char*) Arial12x12_prop); // select the font
TickTock 44:6262a9fd1e56 305 max=0;
TickTock 44:6262a9fd1e56 306 min=9999;
TickTock 44:6262a9fd1e56 307 avg=0;
TickTock 44:6262a9fd1e56 308 for(i=0; i<96; i++){
TickTock 44:6262a9fd1e56 309 bd=(battData[i*2+3]<<8)+battData[i*2+4];
TickTock 44:6262a9fd1e56 310 avg+=bd;
TickTock 44:6262a9fd1e56 311 if(bd>max) max=bd;
TickTock 44:6262a9fd1e56 312 if(bd<min) min=bd;
TickTock 44:6262a9fd1e56 313 }
TickTock 44:6262a9fd1e56 314 avg /= 96;
TickTock 44:6262a9fd1e56 315 if(min<3713) {
TickTock 44:6262a9fd1e56 316 jv=avg-(max-avg)*1.5;
TickTock 44:6262a9fd1e56 317 } else { // Only compute judgement value if min cellpair meets <= 3712mV requirement
TickTock 44:6262a9fd1e56 318 jv=0;
TickTock 44:6262a9fd1e56 319 }
TickTock 44:6262a9fd1e56 320
TickTock 44:6262a9fd1e56 321 //------------------
TickTock 44:6262a9fd1e56 322 tt.cls();
TickTock 44:6262a9fd1e56 323
TickTock 44:6262a9fd1e56 324 // show as histogram
TickTock 44:6262a9fd1e56 325 int xWinMin = 20;
TickTock 44:6262a9fd1e56 326 int xWinMax = 300;
TickTock 44:6262a9fd1e56 327 int yWinMin = 50;
TickTock 44:6262a9fd1e56 328 int yWinMax = 150;
TickTock 44:6262a9fd1e56 329 // draw the Histogram Frame, 2 pixels wide
TickTock 44:6262a9fd1e56 330 tt.rect( xWinMin-1,yWinMin-1, xWinMax+1,yWinMax+1,Red);
TickTock 44:6262a9fd1e56 331 tt.rect( xWinMin-2,yWinMin-2, xWinMax+2,yWinMax+2,Green);
TickTock 44:6262a9fd1e56 332
TickTock 44:6262a9fd1e56 333 tt.locate( 0, yWinMax+10 );
TickTock 44:6262a9fd1e56 334 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 44:6262a9fd1e56 335
TickTock 44:6262a9fd1e56 336 // binning
TickTock 44:6262a9fd1e56 337 short nBin[301] ; // bins to count Min values in nBin[0], etc.
TickTock 44:6262a9fd1e56 338 int height ;
TickTock 44:6262a9fd1e56 339 int iBinIndxMax = 300 ;
TickTock 44:6262a9fd1e56 340 int iBinValMax = max - min ; // zero to N
TickTock 44:6262a9fd1e56 341 if( iBinValMax > iBinIndxMax ) iBinValMax = iBinIndxMax ;
TickTock 44:6262a9fd1e56 342
TickTock 44:6262a9fd1e56 343 // clean the bins
TickTock 44:6262a9fd1e56 344 for(int i=0; i<=iBinIndxMax; i++) {
TickTock 44:6262a9fd1e56 345 nBin[i] = 0;
TickTock 44:6262a9fd1e56 346 }
TickTock 44:6262a9fd1e56 347
TickTock 44:6262a9fd1e56 348 // do the bin counting
TickTock 44:6262a9fd1e56 349 for(int i=0; i<96; i++){
TickTock 44:6262a9fd1e56 350 bd=(battData[i*2+3]<<8)+battData[i*2+4] - min ;
TickTock 44:6262a9fd1e56 351 if( bd > iBinValMax ) bd = iBinValMax ;
TickTock 44:6262a9fd1e56 352 nBin[bd] ++ ;
TickTock 44:6262a9fd1e56 353 }
TickTock 44:6262a9fd1e56 354
TickTock 44:6262a9fd1e56 355 //----------------
TickTock 44:6262a9fd1e56 356 if( iBinValMax == 0 ) {
TickTock 44:6262a9fd1e56 357 // for testing
TickTock 44:6262a9fd1e56 358 min = 10 ;
TickTock 44:6262a9fd1e56 359 max = 50 ;
TickTock 44:6262a9fd1e56 360 avg = ( max + min ) / 2;
TickTock 44:6262a9fd1e56 361 iBinValMax = max - min ;
TickTock 44:6262a9fd1e56 362 for(int i=0; i<=(iBinValMax/2); i++) {
TickTock 44:6262a9fd1e56 363 nBin[i] = i ;
TickTock 44:6262a9fd1e56 364 nBin[iBinValMax-i] = i ;
TickTock 44:6262a9fd1e56 365 }
TickTock 44:6262a9fd1e56 366 }
TickTock 44:6262a9fd1e56 367
TickTock 44:6262a9fd1e56 368 //---------------
TickTock 44:6262a9fd1e56 369 // show the bars
TickTock 44:6262a9fd1e56 370 int nBarWidth = 3 ;
TickTock 44:6262a9fd1e56 371 int nBarSpace = 1 ; // 1 for testing
TickTock 44:6262a9fd1e56 372
TickTock 44:6262a9fd1e56 373 int xPos = (xWinMin + xWinMax) / 2 ;
TickTock 44:6262a9fd1e56 374 xPos -= (avg-min) * (nBarWidth + nBarSpace) ;
TickTock 44:6262a9fd1e56 375
TickTock 44:6262a9fd1e56 376 for( int i=0; i<=iBinValMax; i++) {
TickTock 44:6262a9fd1e56 377 height = 4 * nBin[i] ;
TickTock 44:6262a9fd1e56 378 if( height > 100 ) height = 100 ; // clip tops
TickTock 44:6262a9fd1e56 379
TickTock 44:6262a9fd1e56 380 // if inside the window, draw the bar
TickTock 44:6262a9fd1e56 381 if( ( xPos + nBarWidth < xWinMax ) && ( xPos > xWinMin ) )
TickTock 44:6262a9fd1e56 382 tt.fillrect( xPos,yWinMax-height, xPos+nBarWidth-1,yWinMax, Green);
TickTock 44:6262a9fd1e56 383
TickTock 44:6262a9fd1e56 384 // step to the next bar position
TickTock 44:6262a9fd1e56 385 xPos += nBarWidth + nBarSpace ;
TickTock 44:6262a9fd1e56 386 }
TickTock 44:6262a9fd1e56 387
TickTock 44:6262a9fd1e56 388 showCP=false;
TickTock 44:6262a9fd1e56 389 }
TickTock 44:6262a9fd1e56 390
TickTock 44:6262a9fd1e56 391 // handle the button
TickTock 44:6262a9fd1e56 392 if(sMode==1){
TickTock 44:6262a9fd1e56 393 tt.foreground(Yellow);
TickTock 44:6262a9fd1e56 394 tt.background(DarkCyan);
TickTock 44:6262a9fd1e56 395 tt.set_font((unsigned char*) Arial12x12);
TickTock 44:6262a9fd1e56 396 sprintf(sTemp1," Request");
TickTock 44:6262a9fd1e56 397 sprintf(sTemp2," CP data");
TickTock 36:dbd39c315258 398 showButton(1,0,sTemp1,sTemp2,3,3);
TickTock 36:dbd39c315258 399 }
TickTock 36:dbd39c315258 400 }
TickTock 36:dbd39c315258 401
TickTock 42:4533b13b297d 402 void config1(bool force, bool showButtons){
TickTock 36:dbd39c315258 403 if (force) {
TickTock 36:dbd39c315258 404 tt.background(Black);
TickTock 36:dbd39c315258 405 tt.cls();
TickTock 36:dbd39c315258 406 }
TickTock 36:dbd39c315258 407 tt.foreground(Yellow);
TickTock 36:dbd39c315258 408 tt.background(DarkCyan);
TickTock 36:dbd39c315258 409 tt.set_font((unsigned char*) Arial12x12);
TickTock 36:dbd39c315258 410 sprintf(sTemp1," Calibrate");
TickTock 36:dbd39c315258 411 sprintf(sTemp2," Touch");
TickTock 36:dbd39c315258 412 showButton(0,0,sTemp1,sTemp2,3,3);
TickTock 36:dbd39c315258 413 sprintf(sTemp1," Reset");
TickTock 36:dbd39c315258 414 sprintf(sTemp2,"");
TickTock 36:dbd39c315258 415 showButton(1,0,sTemp1,sTemp2,3,3);
TickTock 36:dbd39c315258 416 sprintf(sTemp1," Save");
TickTock 36:dbd39c315258 417 sprintf(sTemp2," Config");
TickTock 36:dbd39c315258 418 showButton(2,0,sTemp1,sTemp2,3,3);
TickTock 36:dbd39c315258 419 if (logEn) {
TickTock 36:dbd39c315258 420 sprintf(sTemp1," Disable");
TickTock 36:dbd39c315258 421 } else {
TickTock 36:dbd39c315258 422 sprintf(sTemp1," Enable");
TickTock 36:dbd39c315258 423 }
TickTock 36:dbd39c315258 424 sprintf(sTemp2," Logging");
TickTock 36:dbd39c315258 425 showButton(0,1,sTemp1,sTemp2,3,3);
TickTock 36:dbd39c315258 426 if (repeatPoll) {
TickTock 36:dbd39c315258 427 sprintf(sTemp1," Disable");
TickTock 36:dbd39c315258 428 } else {
TickTock 36:dbd39c315258 429 sprintf(sTemp1," Enable");
TickTock 36:dbd39c315258 430 }
TickTock 36:dbd39c315258 431 sprintf(sTemp2," Auto CP");
TickTock 36:dbd39c315258 432 showButton(1,1,sTemp1,sTemp2,3,3);
TickTock 36:dbd39c315258 433 }
TickTock 36:dbd39c315258 434
TickTock 42:4533b13b297d 435 void pbScreen(bool force, bool showButtons){
TickTock 36:dbd39c315258 436 if (force) {
TickTock 36:dbd39c315258 437 tt.background(Black);
TickTock 36:dbd39c315258 438 tt.cls();
TickTock 36:dbd39c315258 439 }
TickTock 36:dbd39c315258 440 tt.foreground(Yellow);
TickTock 36:dbd39c315258 441 tt.background(DarkCyan);
TickTock 36:dbd39c315258 442 tt.set_font((unsigned char*) Arial12x12);
TickTock 36:dbd39c315258 443 if(playbackOpen){
TickTock 36:dbd39c315258 444 sprintf(sTemp1,"Slower");
TickTock 36:dbd39c315258 445 sprintf(sTemp2," <--");
TickTock 36:dbd39c315258 446 showButton(0,0,sTemp1,sTemp2,3,3);
TickTock 36:dbd39c315258 447 if(playbackEn){
TickTock 36:dbd39c315258 448 sprintf(sTemp1," Pause");
TickTock 36:dbd39c315258 449 }else{
TickTock 36:dbd39c315258 450 sprintf(sTemp1," Run");
TickTock 36:dbd39c315258 451 }
TickTock 36:dbd39c315258 452 sprintf(sTemp2," %4.3f ",playbackInt);
TickTock 36:dbd39c315258 453 showButton(1,0,sTemp1,sTemp2,3,3);
TickTock 36:dbd39c315258 454 sprintf(sTemp1,"Faster");
TickTock 36:dbd39c315258 455 sprintf(sTemp2," -->");
TickTock 36:dbd39c315258 456 showButton(2,0,sTemp1,sTemp2,3,3);
TickTock 36:dbd39c315258 457 }
TickTock 36:dbd39c315258 458 if(playbackOpen){
TickTock 36:dbd39c315258 459 sprintf(sTemp1," Stop");
TickTock 36:dbd39c315258 460 }else{
TickTock 36:dbd39c315258 461 sprintf(sTemp1," Start");
TickTock 36:dbd39c315258 462 }
TickTock 36:dbd39c315258 463 sprintf(sTemp2,"Playback");
TickTock 36:dbd39c315258 464 showButton(1,1,sTemp1,sTemp2,3,3);
TickTock 36:dbd39c315258 465 }
TickTock 36:dbd39c315258 466
TickTock 42:4533b13b297d 467 void showDateTime(bool force, bool showButtons){
TickTock 36:dbd39c315258 468 struct tm t; // pointer to a static tm structure
TickTock 36:dbd39c315258 469 time_t seconds ;
TickTock 36:dbd39c315258 470 tt.foreground(Yellow);
TickTock 44:6262a9fd1e56 471 tt.background(Black);
TickTock 36:dbd39c315258 472 if (force) {
TickTock 36:dbd39c315258 473 tt.cls();
TickTock 36:dbd39c315258 474 seconds = time(NULL);
TickTock 36:dbd39c315258 475 t = *localtime(&seconds) ;
TickTock 36:dbd39c315258 476
TickTock 36:dbd39c315258 477 tt.locate(10,10);
TickTock 43:e7f6f80590e3 478 tt.set_font((unsigned char*) Arial12x12);
TickTock 36:dbd39c315258 479 strftime(sTemp1, 32, "%a %m/%d/%Y %X \n", &t);
TickTock 36:dbd39c315258 480 printf("%s",sTemp1);
TickTock 42:4533b13b297d 481 if((sMode==1)&&showButtons){
TickTock 36:dbd39c315258 482 sprintf(sTemp2,"");
TickTock 36:dbd39c315258 483 switch(dtMode){
TickTock 36:dbd39c315258 484 case 0:
TickTock 36:dbd39c315258 485 sprintf(sTemp1,"Year");
TickTock 36:dbd39c315258 486 break;
TickTock 36:dbd39c315258 487 case 1:
TickTock 36:dbd39c315258 488 sprintf(sTemp1,"Month");
TickTock 36:dbd39c315258 489 break;
TickTock 36:dbd39c315258 490 case 2:
TickTock 36:dbd39c315258 491 sprintf(sTemp1,"Day");
TickTock 36:dbd39c315258 492 break;
TickTock 36:dbd39c315258 493 case 3:
TickTock 36:dbd39c315258 494 sprintf(sTemp1,"Hour");
TickTock 36:dbd39c315258 495 break;
TickTock 36:dbd39c315258 496 case 4:
TickTock 36:dbd39c315258 497 sprintf(sTemp1,"Minute");
TickTock 36:dbd39c315258 498 break;
TickTock 36:dbd39c315258 499 case 5:
TickTock 36:dbd39c315258 500 sprintf(sTemp1,"Second");
TickTock 36:dbd39c315258 501 break;
TickTock 36:dbd39c315258 502 case 6:
TickTock 36:dbd39c315258 503 sprintf(sTemp1,"Select");
TickTock 36:dbd39c315258 504 break;
TickTock 36:dbd39c315258 505 default:
TickTock 36:dbd39c315258 506 break;
TickTock 36:dbd39c315258 507 }
TickTock 44:6262a9fd1e56 508 tt.background(DarkCyan);
TickTock 36:dbd39c315258 509 showButton(0,1,sTemp1,sTemp2,3,3);
TickTock 36:dbd39c315258 510 sprintf(sTemp1," UP");
TickTock 36:dbd39c315258 511 showButton(1,1,sTemp1,sTemp2,3,3);
TickTock 36:dbd39c315258 512 sprintf(sTemp1," DOWN");
TickTock 36:dbd39c315258 513 showButton(2,1,sTemp1,sTemp2,3,3);
TickTock 36:dbd39c315258 514 }
TickTock 36:dbd39c315258 515 }
TickTock 36:dbd39c315258 516 }
TickTock 36:dbd39c315258 517
TickTock 42:4533b13b297d 518 void dteDisplay(bool force, bool showButtons){
TickTock 41:8d4609ea7259 519 static float lmpkWh=0;
TickTock 41:8d4609ea7259 520 static float lMPH=0;
TickTock 37:fea2c1d52c5f 521 tt.background(Navy);
TickTock 37:fea2c1d52c5f 522 if(force) tt.cls();
TickTock 41:8d4609ea7259 523 if(force||mpkWh!=lmpkWh||MPH!=lMPH){
TickTock 37:fea2c1d52c5f 524 tt.foreground(Yellow);
TickTock 37:fea2c1d52c5f 525 tt.set_font((unsigned char*) Arial28x28);
TickTock 37:fea2c1d52c5f 526 tt.locate(10,200);
TickTock 43:e7f6f80590e3 527 printf("%3.1f \n",MPH);
TickTock 37:fea2c1d52c5f 528 tt.locate(200,200);
TickTock 43:e7f6f80590e3 529 printf("%3.1f \n",mpkWh);
TickTock 41:8d4609ea7259 530 lmpkWh=mpkWh;
TickTock 41:8d4609ea7259 531 lMPH=MPH;
TickTock 37:fea2c1d52c5f 532 }
TickTock 37:fea2c1d52c5f 533 }
TickTock 37:fea2c1d52c5f 534
TickTock 36:dbd39c315258 535 void updateDisplay(char display){
TickTock 36:dbd39c315258 536 bool changed;
TickTock 36:dbd39c315258 537 changed = dMode[display]!=lastDMode[display];
TickTock 36:dbd39c315258 538 tt.set_display(display);
TickTock 36:dbd39c315258 539 switch (dMode[display]) {
TickTock 36:dbd39c315258 540 case logScreen:
TickTock 42:4533b13b297d 541 printLog(changed,(display==whichTouched));
TickTock 36:dbd39c315258 542 break;
TickTock 41:8d4609ea7259 543 case mainScreen:
TickTock 42:4533b13b297d 544 mainDisplay(changed,(display==whichTouched));
TickTock 36:dbd39c315258 545 break;
TickTock 36:dbd39c315258 546 case brakeScreen:
TickTock 42:4533b13b297d 547 braking(changed,(display==whichTouched));
TickTock 36:dbd39c315258 548 break;
TickTock 41:8d4609ea7259 549 case dteScreen:
TickTock 42:4533b13b297d 550 dteDisplay(changed,(display==whichTouched));
TickTock 37:fea2c1d52c5f 551 break;
TickTock 36:dbd39c315258 552 case monitorScreen:
TickTock 42:4533b13b297d 553 printLast(changed,(display==whichTouched));
TickTock 36:dbd39c315258 554 break;
TickTock 36:dbd39c315258 555 case changedScreen:
TickTock 42:4533b13b297d 556 printChanged(changed,(display==whichTouched));
TickTock 36:dbd39c315258 557 break;
TickTock 36:dbd39c315258 558 case cpScreen:
TickTock 42:4533b13b297d 559 cpData(changed||showCP,(display==whichTouched));
TickTock 36:dbd39c315258 560 break;
TickTock 36:dbd39c315258 561 case config1Screen:
TickTock 42:4533b13b297d 562 config1(changed,(display==whichTouched));
TickTock 36:dbd39c315258 563 break;
TickTock 38:155ec32c5e91 564 case playbackScreen:
TickTock 42:4533b13b297d 565 pbScreen(changed,(display==whichTouched));
TickTock 36:dbd39c315258 566 break;
TickTock 36:dbd39c315258 567 case dateScreen:
TickTock 42:4533b13b297d 568 showDateTime(changed,(display==whichTouched));
TickTock 36:dbd39c315258 569 break;
TickTock 44:6262a9fd1e56 570 case cpHistScreen: // gg - hist
TickTock 44:6262a9fd1e56 571 cpHistogram(changed);
TickTock 44:6262a9fd1e56 572 break;
TickTock 36:dbd39c315258 573 default:
TickTock 43:e7f6f80590e3 574 if (changed){
TickTock 43:e7f6f80590e3 575 tt.background(Black);
TickTock 43:e7f6f80590e3 576 tt.cls();
TickTock 43:e7f6f80590e3 577 }
TickTock 36:dbd39c315258 578 break;
TickTock 36:dbd39c315258 579 }
TickTock 36:dbd39c315258 580 lastDMode[display]=dMode[display];
TickTock 36:dbd39c315258 581
TickTock 42:4533b13b297d 582 if(display==whichTouched){
TickTock 42:4533b13b297d 583 switch (sMode) {
TickTock 42:4533b13b297d 584 case 1: // Select screens
TickTock 42:4533b13b297d 585 tt.foreground(Yellow);
TickTock 42:4533b13b297d 586 tt.background(DarkCyan);
TickTock 42:4533b13b297d 587 tt.set_font((unsigned char*) Arial12x12);
TickTock 42:4533b13b297d 588 sprintf(sTemp1,"<-Prev");
TickTock 42:4533b13b297d 589 sprintf(sTemp2,"");
TickTock 42:4533b13b297d 590 showButton(0,2,sTemp1,sTemp2,3,3);
TickTock 43:e7f6f80590e3 591 sprintf(sTemp1," Next->");
TickTock 42:4533b13b297d 592 showButton(2,2,sTemp1,sTemp2,3,3);
TickTock 43:e7f6f80590e3 593 sprintf(sTemp1," Select");
TickTock 42:4533b13b297d 594 switch (dMode[display]) {
TickTock 44:6262a9fd1e56 595 case offScreen:
TickTock 43:e7f6f80590e3 596 sprintf(sTemp2," Off");
TickTock 42:4533b13b297d 597 break;
TickTock 44:6262a9fd1e56 598 case logScreen:
TickTock 43:e7f6f80590e3 599 sprintf(sTemp2," Log");
TickTock 42:4533b13b297d 600 break;
TickTock 44:6262a9fd1e56 601 case mainScreen:
TickTock 43:e7f6f80590e3 602 sprintf(sTemp2," Main");
TickTock 42:4533b13b297d 603 break;
TickTock 44:6262a9fd1e56 604 case brakeScreen:
TickTock 42:4533b13b297d 605 sprintf(sTemp2," Braking");
TickTock 42:4533b13b297d 606 break;
TickTock 44:6262a9fd1e56 607 case dteScreen:
TickTock 43:e7f6f80590e3 608 sprintf(sTemp2," DTE");
TickTock 42:4533b13b297d 609 break;
TickTock 44:6262a9fd1e56 610 case monitorScreen:
TickTock 43:e7f6f80590e3 611 sprintf(sTemp2," Monitor");
TickTock 42:4533b13b297d 612 break;
TickTock 44:6262a9fd1e56 613 case changedScreen:
TickTock 42:4533b13b297d 614 sprintf(sTemp2,"Delta Mon");
TickTock 42:4533b13b297d 615 break;
TickTock 44:6262a9fd1e56 616 case cpScreen:
TickTock 43:e7f6f80590e3 617 sprintf(sTemp2," Cell Pair");
TickTock 42:4533b13b297d 618 break;
TickTock 44:6262a9fd1e56 619 case config1Screen:
TickTock 43:e7f6f80590e3 620 sprintf(sTemp2," Config");
TickTock 42:4533b13b297d 621 break;
TickTock 44:6262a9fd1e56 622 case playbackScreen:
TickTock 43:e7f6f80590e3 623 sprintf(sTemp2," Playback");
TickTock 42:4533b13b297d 624 break;
TickTock 44:6262a9fd1e56 625 case dateScreen:
TickTock 43:e7f6f80590e3 626 sprintf(sTemp2," Set Time");
TickTock 42:4533b13b297d 627 break;
TickTock 44:6262a9fd1e56 628 case cpHistScreen: // gg - hist
TickTock 44:6262a9fd1e56 629 sprintf(sTemp2," CP Hist");
TickTock 44:6262a9fd1e56 630 break;
TickTock 42:4533b13b297d 631 }
TickTock 42:4533b13b297d 632 showButton(1,2,sTemp1,sTemp2,3,3);
TickTock 42:4533b13b297d 633 wait_ms(100); // pause a moment to reduce flicker
TickTock 42:4533b13b297d 634 break;
TickTock 42:4533b13b297d 635 case 2: // numpad
TickTock 42:4533b13b297d 636 sprintf(sTemp2,"");
TickTock 42:4533b13b297d 637 tt.foreground(Yellow);
TickTock 42:4533b13b297d 638 tt.background(DarkCyan);
TickTock 42:4533b13b297d 639 tt.set_font((unsigned char*) Arial24x23);
TickTock 42:4533b13b297d 640 sprintf(sTemp1," 1");
TickTock 42:4533b13b297d 641 showButton(0,0,sTemp1,sTemp2,4,4);
TickTock 42:4533b13b297d 642 sprintf(sTemp1," 2");
TickTock 42:4533b13b297d 643 showButton(1,0,sTemp1,sTemp2,4,4);
TickTock 42:4533b13b297d 644 sprintf(sTemp1," 3");
TickTock 42:4533b13b297d 645 showButton(2,0,sTemp1,sTemp2,4,4);
TickTock 42:4533b13b297d 646 sprintf(sTemp1," 4");
TickTock 42:4533b13b297d 647 showButton(0,1,sTemp1,sTemp2,4,4);
TickTock 42:4533b13b297d 648 sprintf(sTemp1," 5");
TickTock 42:4533b13b297d 649 showButton(1,1,sTemp1,sTemp2,4,4);
TickTock 42:4533b13b297d 650 sprintf(sTemp1," 6");
TickTock 42:4533b13b297d 651 showButton(2,1,sTemp1,sTemp2,4,4);
TickTock 42:4533b13b297d 652 sprintf(sTemp1," 7");
TickTock 42:4533b13b297d 653 showButton(0,2,sTemp1,sTemp2,4,4);
TickTock 42:4533b13b297d 654 sprintf(sTemp1," 8");
TickTock 42:4533b13b297d 655 showButton(1,2,sTemp1,sTemp2,4,4);
TickTock 42:4533b13b297d 656 sprintf(sTemp1," 9");
TickTock 42:4533b13b297d 657 showButton(2,2,sTemp1,sTemp2,4,4);
TickTock 42:4533b13b297d 658 sprintf(sTemp1," 0");
TickTock 42:4533b13b297d 659 showButton(1,3,sTemp1,sTemp2,4,4);
TickTock 42:4533b13b297d 660 sprintf(sTemp1,"<--");
TickTock 42:4533b13b297d 661 showButton(0,3,sTemp1,sTemp2,4,4);
TickTock 42:4533b13b297d 662 sprintf(sTemp1,"-->");
TickTock 42:4533b13b297d 663 showButton(2,3,sTemp1,sTemp2,4,4);
TickTock 42:4533b13b297d 664 sprintf(sTemp1,"return");
TickTock 42:4533b13b297d 665 showButton(3,3,sTemp1,sTemp2,4,4);
TickTock 42:4533b13b297d 666 case 3:
TickTock 42:4533b13b297d 667 break;
TickTock 42:4533b13b297d 668 default:
TickTock 42:4533b13b297d 669 break;
TickTock 42:4533b13b297d 670 }
TickTock 36:dbd39c315258 671 }
TickTock 36:dbd39c315258 672 }
TickTock 36:dbd39c315258 673
TickTock 36:dbd39c315258 674 void showButton(unsigned char column, unsigned char row, char * text1, char * text2, unsigned char columns, unsigned char rows){
TickTock 36:dbd39c315258 675 unsigned short x1,x2,y1,y2;
TickTock 36:dbd39c315258 676 x1=column*(320/columns)+btnGap/2;
TickTock 36:dbd39c315258 677 x2=(column+1)*(320/columns)-btnGap/2;
TickTock 36:dbd39c315258 678 y1=row*(240/rows)+btnGap/2;
TickTock 36:dbd39c315258 679 y2=(row+1)*(240/rows)-btnGap/2;
TickTock 36:dbd39c315258 680 tt.fillrect(x1,y1,x2,y2,DarkCyan);
TickTock 36:dbd39c315258 681 tt.locate(x1+btnGap,y1+btnGap);
TickTock 36:dbd39c315258 682 printf("%s\n",text1);
TickTock 36:dbd39c315258 683 tt.locate(x1+btnGap,y1+btnGap+30);
TickTock 36:dbd39c315258 684 printf("%s\n",text2);
TickTock 36:dbd39c315258 685 }
TickTock 41:8d4609ea7259 686 // below is braking screen normalized to power rather than force
TickTock 41:8d4609ea7259 687 // changed to force since power had too large a dynamic range
TickTock 42:4533b13b297d 688 /*void braking (bool force, bool showButtons, bool prdata=false){
TickTock 23:cd03f9c3395e 689 unsigned long targetBraking, regenBraking, speed;
TickTock 27:6bd073c33977 690 static unsigned long maxTarget = 20000, maxRegen = 20000, tarDivReg = 1000;
TickTock 13:62e0f7f39ff5 691 short rpm;
TickTock 13:62e0f7f39ff5 692 unsigned long temp;
TickTock 13:62e0f7f39ff5 693 static unsigned char lastPressure[4] = {200,200,200,200};
TickTock 13:62e0f7f39ff5 694 unsigned char i,r,t;
TickTock 13:62e0f7f39ff5 695 static unsigned char lr, lt;
TickTock 13:62e0f7f39ff5 696 CANMessage msg;
TickTock 13:62e0f7f39ff5 697
TickTock 13:62e0f7f39ff5 698 msg = lastMsg[indexLastMsg[0x1cb]]; //Get Target and Regen
TickTock 13:62e0f7f39ff5 699 regenBraking = (msg.data[0]<<3)+(msg.data[1]>>5);
TickTock 13:62e0f7f39ff5 700 targetBraking = (msg.data[2]<<3)+(msg.data[3]>>5);
TickTock 13:62e0f7f39ff5 701 msg = lastMsg[indexLastMsg[0x176]]; //Get rpms - not sure what this is but scales to mph with .0725
TickTock 13:62e0f7f39ff5 702 rpm = ((short)msg.data[0]<<8)+msg.data[1];
TickTock 13:62e0f7f39ff5 703 speed =rpm>0?rpm>>3:-rpm>>3; //Take absolute to get speed; div8
TickTock 23:cd03f9c3395e 704 if ((targetBraking>2039)||(speed>200)) { //Filter weird messages
TickTock 23:cd03f9c3395e 705 targetBraking = 0;
TickTock 23:cd03f9c3395e 706 regenBraking = 0;
TickTock 23:cd03f9c3395e 707 } else {
TickTock 23:cd03f9c3395e 708 if ((targetBraking>50)&&(regenBraking>50)){
TickTock 23:cd03f9c3395e 709 temp = targetBraking;
TickTock 23:cd03f9c3395e 710 temp *= 1000;
TickTock 23:cd03f9c3395e 711 temp /= regenBraking;
TickTock 23:cd03f9c3395e 712 if (temp<tarDivReg) tarDivReg=temp;
TickTock 23:cd03f9c3395e 713 }
TickTock 23:cd03f9c3395e 714 targetBraking *= speed;
TickTock 23:cd03f9c3395e 715 regenBraking *= speed;
TickTock 23:cd03f9c3395e 716 if (targetBraking>maxTarget) maxTarget=targetBraking;
TickTock 23:cd03f9c3395e 717 if (regenBraking>maxRegen) maxRegen=regenBraking;
TickTock 23:cd03f9c3395e 718 }
TickTock 23:cd03f9c3395e 719
TickTock 13:62e0f7f39ff5 720 msg = lastMsg[indexLastMsg[0x1ca]]; //Get brake pressure
TickTock 13:62e0f7f39ff5 721 tt.background(Navy);
TickTock 13:62e0f7f39ff5 722 if (force) {
TickTock 13:62e0f7f39ff5 723 tt.cls();
TickTock 13:62e0f7f39ff5 724 tt.rect(0,111,170,239,White);
TickTock 13:62e0f7f39ff5 725 tt.line(0,207,170,207,White);
TickTock 13:62e0f7f39ff5 726 tt.line(0,175,170,175,White);
TickTock 13:62e0f7f39ff5 727 tt.line(0,143,170,143,White);
TickTock 13:62e0f7f39ff5 728 lastPressure[0] = 200;
TickTock 13:62e0f7f39ff5 729 lastPressure[1] = 200;
TickTock 13:62e0f7f39ff5 730 lastPressure[2] = 200;
TickTock 13:62e0f7f39ff5 731 lastPressure[3] = 200;
TickTock 13:62e0f7f39ff5 732 }
TickTock 13:62e0f7f39ff5 733 // plot bar graph for each wheel pressure
TickTock 13:62e0f7f39ff5 734 for (i=0; i<4; i++){
TickTock 13:62e0f7f39ff5 735 if (msg.data[i]<239) {
TickTock 13:62e0f7f39ff5 736 if (msg.data[i]>lastPressure[i]){
TickTock 13:62e0f7f39ff5 737 tt.fillrect(10+40*i,239-msg.data[i],40+40*i,239,Red);
TickTock 13:62e0f7f39ff5 738 } else if (msg.data[i]<lastPressure[i]) {
TickTock 13:62e0f7f39ff5 739 tt.fillrect(10+40*i,238-lastPressure[i],40+40*i,238-msg.data[i],Navy);
TickTock 13:62e0f7f39ff5 740 }
TickTock 13:62e0f7f39ff5 741 lastPressure[i]=msg.data[i];
TickTock 13:62e0f7f39ff5 742 }
TickTock 13:62e0f7f39ff5 743 }
TickTock 13:62e0f7f39ff5 744
TickTock 27:6bd073c33977 745 temp = targetBraking;
TickTock 27:6bd073c33977 746 temp *=200;
TickTock 27:6bd073c33977 747 temp /= maxTarget;
TickTock 27:6bd073c33977 748 t = (char) temp;
TickTock 27:6bd073c33977 749 if (t>200) t=200;
TickTock 27:6bd073c33977 750 temp = regenBraking;
TickTock 27:6bd073c33977 751 temp *= tarDivReg;
TickTock 27:6bd073c33977 752 temp /= maxTarget;
TickTock 27:6bd073c33977 753 temp /= 5;
TickTock 27:6bd073c33977 754 r = (char) temp;
TickTock 27:6bd073c33977 755 if (r>200) r=200;
TickTock 27:6bd073c33977 756 if(lr!=r&&prdata){
TickTock 27:6bd073c33977 757 tt.foreground(Yellow);
TickTock 27:6bd073c33977 758 tt.set_font((unsigned char*) Arial28x28);
TickTock 27:6bd073c33977 759 tt.locate(100,40);
TickTock 27:6bd073c33977 760 printf("%d %d \n",regenBraking,maxRegen);
TickTock 27:6bd073c33977 761 tt.locate(100,70);
TickTock 27:6bd073c33977 762 printf("%3.1f (%3.1f%s) \n",(float)tarDivReg/10,(float)regenBraking*tarDivReg/targetBraking/10,"%");
TickTock 27:6bd073c33977 763 }
TickTock 27:6bd073c33977 764 if(lt!=t&&prdata){
TickTock 27:6bd073c33977 765 tt.foreground(Yellow);
TickTock 27:6bd073c33977 766 tt.set_font((unsigned char*) Arial28x28);
TickTock 27:6bd073c33977 767 tt.locate(100,10);
TickTock 27:6bd073c33977 768 printf("%d %d \n",targetBraking,maxTarget);
TickTock 13:62e0f7f39ff5 769 }
TickTock 27:6bd073c33977 770 if (r>t) t=r; //Should never happen
TickTock 27:6bd073c33977 771 if((lr!=r||lt!=t)&&!prdata){
TickTock 27:6bd073c33977 772 tt.fillrect(200,10,300,239-t,Navy);
TickTock 27:6bd073c33977 773 tt.fillrect(200,239-t,300,239-r,Red);
TickTock 27:6bd073c33977 774 tt.fillrect(200,239-r,300,239,Green);
TickTock 27:6bd073c33977 775 }
TickTock 27:6bd073c33977 776 lt=t;
TickTock 27:6bd073c33977 777 lr=r;
TickTock 36:dbd39c315258 778 }*/