Dual CANbus monitor and instrumentation cluster supporting ILI9341 display controller

Dependencies:   SPI_TFTx2_ILI9341 TOUCH_TFTx2_ILI9341 TFT_fonts mbed

Fork of CANary by Tick Tock

Committer:
TickTock
Date:
Sat Jun 29 02:44:02 2013 +0000
Branch:
Metric
Revision:
107:e9be732c1ad4
Parent:
106:f016912a03db
Child:
108:29b5a760adc2
Added trip meter

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 92:935adef49ea4 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);
garygid 54:6ce808d0995e 22
garygid 54:6ce808d0995e 23 showButton(0,0," <up>","",4,4);
garygid 54:6ce808d0995e 24 showButton(2,0,"<down>","",4,4);
TickTock 25:ddf0ec209f03 25 }
TickTock 13:62e0f7f39ff5 26 }
TickTock 13:62e0f7f39ff5 27
TickTock 42:4533b13b297d 28 void printChanged (bool force, bool showButtons){
TickTock 13:62e0f7f39ff5 29 CANMessage msg;
TickTock 13:62e0f7f39ff5 30 unsigned char i,j;
TickTock 13:62e0f7f39ff5 31 tt.locate(0,6);
TickTock 13:62e0f7f39ff5 32 tt.foreground(Red);
TickTock 13:62e0f7f39ff5 33 tt.background(Yellow);
TickTock 13:62e0f7f39ff5 34 if(force) tt.cls(); // Just clear screen if forced - always update display
TickTock 13:62e0f7f39ff5 35 tt.set_font((unsigned char*) Arial12x12_prop); // select the font
TickTock 13:62e0f7f39ff5 36 i=0;
TickTock 13:62e0f7f39ff5 37 j=indexOffset;
TickTock 13:62e0f7f39ff5 38 do{
TickTock 13:62e0f7f39ff5 39 j=j<99?j+1:j;
TickTock 13:62e0f7f39ff5 40 if(msgChanged[j]>0){
TickTock 13:62e0f7f39ff5 41 msg = lastMsg[j];
TickTock 13:62e0f7f39ff5 42 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 92:935adef49ea4 43 i++;
TickTock 13:62e0f7f39ff5 44 }// if changed
TickTock 13:62e0f7f39ff5 45 }while(i<19&&j<99);
TickTock 42:4533b13b297d 46 if((sMode==1)&&showButtons){
TickTock 40:0e6e71a7323f 47 tt.foreground(Yellow);
TickTock 40:0e6e71a7323f 48 tt.background(DarkCyan);
TickTock 40:0e6e71a7323f 49 tt.set_font((unsigned char*) Arial12x12);
garygid 54:6ce808d0995e 50
garygid 54:6ce808d0995e 51 showButton(0,0," <up>","",4,4);
garygid 54:6ce808d0995e 52 showButton(2,0," <down>","",4,4);
garygid 54:6ce808d0995e 53 showButton(1,0," Reset","Baseline",4,4);
TickTock 40:0e6e71a7323f 54 }
TickTock 13:62e0f7f39ff5 55 }
TickTock 13:62e0f7f39ff5 56
TickTock 42:4533b13b297d 57 void printLog (bool force, bool showButtons){
TickTock 97:a25940fd7b5b 58 static unsigned char lastldl = 0;
TickTock 97:a25940fd7b5b 59 unsigned char ldl=displayLoc;
TickTock 97:a25940fd7b5b 60 if(force||ldl!=lastldl){ //only update if changed
TickTock 13:62e0f7f39ff5 61 tt.foreground(Amber);
TickTock 13:62e0f7f39ff5 62 tt.background(Black);
TickTock 13:62e0f7f39ff5 63 tt.cls();
TickTock 13:62e0f7f39ff5 64 tt.locate(0,6);
TickTock 13:62e0f7f39ff5 65 tt.set_font((unsigned char*) Arial12x12);
TickTock 92:935adef49ea4 66 for(int i=0; i<19; i++){
TickTock 97:a25940fd7b5b 67 printf("%s",displayLog[ldl]);
TickTock 97:a25940fd7b5b 68 ldl=ldl>17?0:ldl+1;
TickTock 13:62e0f7f39ff5 69 }
TickTock 13:62e0f7f39ff5 70 }
TickTock 97:a25940fd7b5b 71 lastldl=ldl;
TickTock 13:62e0f7f39ff5 72 }
TickTock 13:62e0f7f39ff5 73
TickTock 107:e9be732c1ad4 74 void tripDisplay (bool force, bool showButtons){
TickTock 107:e9be732c1ad4 75 static float lmiles=0;
TickTock 107:e9be732c1ad4 76 tt.background(White);
TickTock 107:e9be732c1ad4 77 if(force){
TickTock 107:e9be732c1ad4 78 tt.cls();
TickTock 107:e9be732c1ad4 79 }
TickTock 107:e9be732c1ad4 80 if(force||lmiles!=miles_trip[0]){ //only update if changed
TickTock 107:e9be732c1ad4 81 tt.foreground(Navy);
TickTock 107:e9be732c1ad4 82 tt.set_font((unsigned char*) Arial28x28);
TickTock 107:e9be732c1ad4 83 tt.locate(1,10);
TickTock 107:e9be732c1ad4 84 printf("kWh : %s : Eff\n",distanceUnit());
TickTock 107:e9be732c1ad4 85 for(int i=0; i<3; i++){
TickTock 107:e9be732c1ad4 86 tt.locate(1,60+i*40);
TickTock 107:e9be732c1ad4 87 printf("%3.2f : %3.1f : %2.1f\n",kWh_trip[i],convertDistance(miles_trip[i]),convertDistance(miles_trip[i])/kWh_trip[i]);
TickTock 107:e9be732c1ad4 88 }
TickTock 107:e9be732c1ad4 89 tt.set_font((unsigned char*) Arial12x12);
TickTock 107:e9be732c1ad4 90 showButton(3,1," Reset","",4,4);
TickTock 107:e9be732c1ad4 91 showButton(3,2," Reset","",4,4);
TickTock 107:e9be732c1ad4 92 }
TickTock 107:e9be732c1ad4 93 }
TickTock 107:e9be732c1ad4 94
TickTock 42:4533b13b297d 95 void mainDisplay (bool force, bool showButtons){
TickTock 13:62e0f7f39ff5 96 unsigned short gids, SOC, packV;
TickTock 102:fd19f777a0b4 97 static unsigned short lgids=0, lSOC=0, lSOH=0, lpackV=0, maxPS=0;
TickTock 102:fd19f777a0b4 98 static signed short lbattTemp_x10=0;
TickTock 49:a3d2c5bb3cfa 99 static float lkW=0, laccV=0, lmpkWh=0;
TickTock 102:fd19f777a0b4 100 static unsigned long lAh=0;
TickTock 13:62e0f7f39ff5 101 CANMessage msg;
TickTock 13:62e0f7f39ff5 102
TickTock 13:62e0f7f39ff5 103 msg = lastMsg[indexLastMsg[0x5bc]]; //Get gids
TickTock 13:62e0f7f39ff5 104 gids = (msg.data[0]<<2)+(msg.data[1]>>6);
TickTock 13:62e0f7f39ff5 105 msg = lastMsg[indexLastMsg[0x55b]]; //Get SOC
TickTock 13:62e0f7f39ff5 106 SOC = (msg.data[0]<<2)+(msg.data[1]>>6);
TickTock 13:62e0f7f39ff5 107 msg = lastMsg[indexLastMsg[0x1db]]; //Get pack volts
TickTock 13:62e0f7f39ff5 108 packV = (msg.data[2]<<2)+(msg.data[3]>>6);
TickTock 13:62e0f7f39ff5 109
TickTock 13:62e0f7f39ff5 110 tt.background(Navy);
TickTock 38:155ec32c5e91 111 tt.foreground(Yellow);
TickTock 38:155ec32c5e91 112 tt.set_font((unsigned char*) Arial28x28);
TickTock 13:62e0f7f39ff5 113 if(force) tt.cls();
TickTock 48:d1ce92104a1f 114 if(skin==ttSkin){
TickTock 50:83d5864c64a0 115 if(force||gids!=lgids||mpkWh[dtePeriod]!=lmpkWh){
TickTock 48:d1ce92104a1f 116 tt.locate(10,10);
TickTock 48:d1ce92104a1f 117 printf("%4d gids \n",gids);
TickTock 73:62ee8eae3a84 118 if(debugMode){
TickTock 73:62ee8eae3a84 119 if(pointerSep>maxPS){maxPS=pointerSep;}
TickTock 73:62ee8eae3a84 120 tt.locate(10,70);
TickTock 73:62ee8eae3a84 121 printf("%3d sep %3d max\n",pointerSep,maxPS);
TickTock 73:62ee8eae3a84 122 }
TickTock 49:a3d2c5bb3cfa 123 tt.locate(10,40);
TickTock 49:a3d2c5bb3cfa 124 printf("%4.1f kWh \n",(float)(gids-5)*0.075);
TickTock 48:d1ce92104a1f 125 tt.set_font((unsigned char*) SCProSB31x55);
TickTock 48:d1ce92104a1f 126 tt.foreground(Green);
TickTock 102:fd19f777a0b4 127 tt.locate(60,106);
leafman 98:9f8bab96edff 128 printf("%4.1f %s \n",convertDistance(mpkWh[dtePeriod]*((float)(gids-5)*.075)),distanceUnit()); //LM - add metric conversion
TickTock 48:d1ce92104a1f 129 lgids=gids;
TickTock 50:83d5864c64a0 130 lmpkWh=mpkWh[dtePeriod];
TickTock 48:d1ce92104a1f 131 tt.foreground(Yellow);
TickTock 48:d1ce92104a1f 132 tt.set_font((unsigned char*) Arial28x28);
TickTock 48:d1ce92104a1f 133 }
TickTock 48:d1ce92104a1f 134 if(force||SOC!=lSOC){
TickTock 48:d1ce92104a1f 135 tt.locate(200,10);
TickTock 48:d1ce92104a1f 136 printf("%4.1f%s\n",(float)SOC/10,"% ");
TickTock 48:d1ce92104a1f 137 lSOC=SOC;
TickTock 48:d1ce92104a1f 138 }
TickTock 48:d1ce92104a1f 139 if(force||packV!=lpackV){
TickTock 48:d1ce92104a1f 140 tt.locate(200,200);
TickTock 48:d1ce92104a1f 141 printf("%4.1fV \n",(float)packV/2);
TickTock 48:d1ce92104a1f 142 lpackV=packV;
TickTock 48:d1ce92104a1f 143 }
TickTock 102:fd19f777a0b4 144 //if(force||battTemp_x4!=lbattTemp_x4){
TickTock 102:fd19f777a0b4 145 if(force||battTemp_x10!=lbattTemp_x10){
TickTock 95:248b3c25a7df 146 tt.locate(200,170);
TickTock 102:fd19f777a0b4 147 //printf("%4.1f%s\n",convertTemperature((float)battTemp_x4*0.25f),temperatureUnit());
TickTock 102:fd19f777a0b4 148 printf("%4.1f%s\n",convertTemperature((float)battTemp_x10*0.1f),temperatureUnit());
TickTock 102:fd19f777a0b4 149 //lbattTemp_x4=battTemp_x4;
TickTock 102:fd19f777a0b4 150 lbattTemp_x10=battTemp_x10;
TickTock 95:248b3c25a7df 151 }
TickTock 48:d1ce92104a1f 152 if(force||accV!=laccV){
TickTock 48:d1ce92104a1f 153 tt.locate(20,200);
TickTock 48:d1ce92104a1f 154 printf("%3.1fV \n",accV);
TickTock 48:d1ce92104a1f 155 laccV=accV;
TickTock 48:d1ce92104a1f 156 }
TickTock 49:a3d2c5bb3cfa 157 if(force||kW[0]!=lkW){
TickTock 102:fd19f777a0b4 158 tt.locate(180,70);
TickTock 49:a3d2c5bb3cfa 159 printf("%3.2fkW \n",kW[0]);
TickTock 49:a3d2c5bb3cfa 160 //printf("%3.1f mpkWh \n",mpkWh[0]);
TickTock 49:a3d2c5bb3cfa 161 lkW=kW[0];
TickTock 48:d1ce92104a1f 162 }
TickTock 102:fd19f777a0b4 163 if(force||Ah_x10000!=lAh){
TickTock 102:fd19f777a0b4 164 tt.locate(10,70);
TickTock 103:1389e9efe8c3 165 printf("% 4.2fAh \n",(float)Ah_x10000/10000);
TickTock 102:fd19f777a0b4 166 lAh=Ah_x10000;
TickTock 102:fd19f777a0b4 167 }
TickTock 102:fd19f777a0b4 168 if(force||SOH_x100!=lSOH){
TickTock 102:fd19f777a0b4 169 tt.locate(180,40);
TickTock 103:1389e9efe8c3 170 printf(" %3.1f%s\n",(float)SOH_x100/100,"% ");
TickTock 102:fd19f777a0b4 171 lSOH=SOH_x100;
TickTock 102:fd19f777a0b4 172 }
TickTock 48:d1ce92104a1f 173 }else {//if(skin==ggSkin){
TickTock 48:d1ce92104a1f 174 if(force||gids!=lgids){
TickTock 48:d1ce92104a1f 175 tt.locate(10,10);
TickTock 48:d1ce92104a1f 176 printf("%4d GIDs \n",gids);
TickTock 48:d1ce92104a1f 177
TickTock 48:d1ce92104a1f 178 tt.locate(40,40); // gg - add GIDs Percent of 281
TickTock 48:d1ce92104a1f 179 printf("%4.1f%s \n", (float)gids*0.355872, "% ") ;
TickTock 48:d1ce92104a1f 180 tt.locate(20,70);
TickTock 48:d1ce92104a1f 181 //printf("%4.1f kWh \n",(float)gids*0.08); // is input, not usable
TickTock 48:d1ce92104a1f 182 printf("%4.1f kwh \n",(float)gids*0.075); // gg - closer to usable
TickTock 48:d1ce92104a1f 183
TickTock 48:d1ce92104a1f 184 tt.set_font((unsigned char*) SCProSB31x55);
TickTock 48:d1ce92104a1f 185 tt.foreground(Green);
TickTock 48:d1ce92104a1f 186 //tt.locate(60,96);
TickTock 48:d1ce92104a1f 187 tt.locate(60,116); // gg - move down a little
leafman 98:9f8bab96edff 188 printf("%4.1f %s \n",convertDistance((float)(gids-5)*0.31),distanceUnit()); // Approx for now - LM added metric
TickTock 48:d1ce92104a1f 189 lgids=gids;
TickTock 48:d1ce92104a1f 190 tt.foreground(Yellow);
TickTock 48:d1ce92104a1f 191 tt.set_font((unsigned char*) Arial28x28);
TickTock 48:d1ce92104a1f 192 }
TickTock 48:d1ce92104a1f 193
TickTock 48:d1ce92104a1f 194 if(force||SOC!=lSOC){
TickTock 48:d1ce92104a1f 195 tt.locate(200,10);
TickTock 48:d1ce92104a1f 196 printf("%4.1f%s\n",(float)SOC/10,"% ");
TickTock 48:d1ce92104a1f 197 lSOC=SOC;
TickTock 48:d1ce92104a1f 198 }
TickTock 48:d1ce92104a1f 199 if(force||packV!=lpackV){
TickTock 48:d1ce92104a1f 200 tt.locate(200,200);
TickTock 48:d1ce92104a1f 201 printf("%4.1fV \n",(float)packV/2);
TickTock 48:d1ce92104a1f 202 lpackV=packV;
TickTock 48:d1ce92104a1f 203 }
TickTock 48:d1ce92104a1f 204 if(force||accV!=laccV){
TickTock 48:d1ce92104a1f 205 tt.locate(20,200);
TickTock 48:d1ce92104a1f 206 printf("%3.1fV \n",accV);
TickTock 48:d1ce92104a1f 207 laccV=accV;
TickTock 48:d1ce92104a1f 208 }
TickTock 49:a3d2c5bb3cfa 209 if(force||kW[0]!=lkW){
TickTock 48:d1ce92104a1f 210 tt.locate(160,40); // gg - move left to keep from wrap
TickTock 49:a3d2c5bb3cfa 211 printf("%3.2fkw \n",kW[0]); // use small w to save space
TickTock 49:a3d2c5bb3cfa 212 lkW=kW[0];
TickTock 48:d1ce92104a1f 213 }
TickTock 35:5acbd8a64a89 214 }
TickTock 106:f016912a03db 215 if(logEn){
TickTock 106:f016912a03db 216 tt.fillcircle(310,10,6,Red);
TickTock 106:f016912a03db 217 }else{
TickTock 106:f016912a03db 218 tt.fillcircle(310,10,6,Navy);
TickTock 106:f016912a03db 219 }
TickTock 13:62e0f7f39ff5 220 }
TickTock 13:62e0f7f39ff5 221
TickTock 42:4533b13b297d 222 void braking (bool force, bool showButtons, bool prdata=false){
TickTock 28:f24ac05645d9 223 unsigned long targetBraking, regenBraking;
TickTock 73:62ee8eae3a84 224 static unsigned long maxTarget = 1000, maxRegen = 1000, tardivreg_x1000 = 1000;
TickTock 28:f24ac05645d9 225 unsigned long temp;
TickTock 28:f24ac05645d9 226 static unsigned char lastPressure[4] = {200,200,200,200};
TickTock 28:f24ac05645d9 227 unsigned char i,r,t;
TickTock 37:fea2c1d52c5f 228 static unsigned char lr=0, lt=0;
TickTock 37:fea2c1d52c5f 229 signed short steering;
TickTock 37:fea2c1d52c5f 230 unsigned short s;
TickTock 37:fea2c1d52c5f 231 static unsigned short ls;
TickTock 37:fea2c1d52c5f 232 unsigned char throttle;
TickTock 37:fea2c1d52c5f 233 static unsigned char lthrottle;
TickTock 48:d1ce92104a1f 234 short steerOutBounds = 0 ;
TickTock 28:f24ac05645d9 235 CANMessage msg;
TickTock 28:f24ac05645d9 236
TickTock 48:d1ce92104a1f 237 //---------------
TickTock 37:fea2c1d52c5f 238 msg = lastMsg[indexLastMsg[0x180]]; //Get Throttle position
TickTock 37:fea2c1d52c5f 239 throttle = msg.data[5];
TickTock 48:d1ce92104a1f 240
TickTock 48:d1ce92104a1f 241 // ---- steering ----
TickTock 37:fea2c1d52c5f 242 msg = lastMsg[indexLastMsg[0x002]]; //Get Steering angle
TickTock 37:fea2c1d52c5f 243 steering = (msg.data[1]<<8)+msg.data[0];
TickTock 48:d1ce92104a1f 244
TickTock 48:d1ce92104a1f 245 if(skin==ttSkin){
TickTock 66:b7476ce7a59e 246 s= (unsigned short) ((steering/10)+155)%310; // this modulo wraps display
TickTock 48:d1ce92104a1f 247 }else{// if(skin==ggSkin){
TickTock 48:d1ce92104a1f 248 // do not go off screen left or right. gg - steering
TickTock 48:d1ce92104a1f 249 short ss = (short) ((steering/15)+160); // less gain 10 -> 15
TickTock 48:d1ce92104a1f 250 if(ss<0) { ss=0; steerOutBounds = 1; }
TickTock 48:d1ce92104a1f 251 if(ss>310) { ss=310; steerOutBounds = 1; }
TickTock 48:d1ce92104a1f 252 s = (unsigned short) ss;
TickTock 48:d1ce92104a1f 253 }
TickTock 48:d1ce92104a1f 254
TickTock 48:d1ce92104a1f 255 //--------------
TickTock 28:f24ac05645d9 256 msg = lastMsg[indexLastMsg[0x1ca]]; //Get brake pressure
TickTock 28:f24ac05645d9 257 tt.background(Navy);
TickTock 28:f24ac05645d9 258 if (force) {
TickTock 28:f24ac05645d9 259 tt.cls();
TickTock 28:f24ac05645d9 260 tt.rect(0,111,170,239,White);
TickTock 28:f24ac05645d9 261 tt.line(0,207,170,207,White);
TickTock 28:f24ac05645d9 262 tt.line(0,175,170,175,White);
TickTock 28:f24ac05645d9 263 tt.line(0,143,170,143,White);
TickTock 28:f24ac05645d9 264 lastPressure[0] = 200;
TickTock 28:f24ac05645d9 265 lastPressure[1] = 200;
TickTock 28:f24ac05645d9 266 lastPressure[2] = 200;
TickTock 28:f24ac05645d9 267 lastPressure[3] = 200;
TickTock 28:f24ac05645d9 268 }
TickTock 48:d1ce92104a1f 269
TickTock 48:d1ce92104a1f 270 // display the steering position small square
TickTock 37:fea2c1d52c5f 271 if (s!=ls){
TickTock 48:d1ce92104a1f 272 // steering position has moved
TickTock 48:d1ce92104a1f 273 //tt.fillrect(ls,5,ls+9,14, Navy); // blank old position
TickTock 48:d1ce92104a1f 274
TickTock 48:d1ce92104a1f 275 //---- gg - steering red
TickTock 48:d1ce92104a1f 276 // box is blanked by top of Braking bar, so move up 5
TickTock 48:d1ce92104a1f 277 tt.fillrect(ls,0,ls+9,9, Navy); // blank old position
TickTock 48:d1ce92104a1f 278 if( steerOutBounds != 0 ) // draw out-of-bounds as a red box
TickTock 48:d1ce92104a1f 279 tt.fillrect(s,0,s+9,9, Red); // draw out-of-bounds position
TickTock 48:d1ce92104a1f 280 else
TickTock 48:d1ce92104a1f 281 tt.fillrect(s,0,s+9,9, White); // draw new in-bounds position
TickTock 48:d1ce92104a1f 282
TickTock 48:d1ce92104a1f 283 //----
TickTock 37:fea2c1d52c5f 284 //tt.foreground(Yellow);
TickTock 37:fea2c1d52c5f 285 //tt.set_font((unsigned char*) Arial28x28);
TickTock 37:fea2c1d52c5f 286 //tt.locate(10,40);
TickTock 37:fea2c1d52c5f 287 //printf("%d %d \n",s,ls);
TickTock 37:fea2c1d52c5f 288 ls=s;
TickTock 37:fea2c1d52c5f 289 }
TickTock 48:d1ce92104a1f 290
TickTock 37:fea2c1d52c5f 291 if (throttle!=lthrottle){
TickTock 37:fea2c1d52c5f 292 if (throttle>239) throttle=239;
TickTock 37:fea2c1d52c5f 293 if(throttle<lthrottle){
TickTock 37:fea2c1d52c5f 294 tt.fillrect(280,239-lthrottle,310,239-throttle,Navy);
TickTock 37:fea2c1d52c5f 295 }else{
TickTock 37:fea2c1d52c5f 296 tt.fillrect(280,239-throttle,310,239,Yellow);
TickTock 37:fea2c1d52c5f 297 }
TickTock 37:fea2c1d52c5f 298 lthrottle=throttle;
TickTock 37:fea2c1d52c5f 299 }
TickTock 37:fea2c1d52c5f 300
TickTock 28:f24ac05645d9 301 // plot bar graph for each wheel pressure
TickTock 92:935adef49ea4 302 for (i=0; i<4; i++){
TickTock 28:f24ac05645d9 303 if (msg.data[i]<239) {
TickTock 28:f24ac05645d9 304 if (msg.data[i]>lastPressure[i]){
TickTock 28:f24ac05645d9 305 tt.fillrect(10+40*i,239-msg.data[i],40+40*i,239,Red);
TickTock 28:f24ac05645d9 306 } else if (msg.data[i]<lastPressure[i]) {
TickTock 28:f24ac05645d9 307 tt.fillrect(10+40*i,238-lastPressure[i],40+40*i,238-msg.data[i],Navy);
TickTock 28:f24ac05645d9 308 }
TickTock 28:f24ac05645d9 309 lastPressure[i]=msg.data[i];
TickTock 28:f24ac05645d9 310 }
TickTock 28:f24ac05645d9 311 }
TickTock 28:f24ac05645d9 312
TickTock 73:62ee8eae3a84 313 msg = lastMsg[indexLastMsg[0x1cb]]; //Get Target and Regen
TickTock 73:62ee8eae3a84 314 regenBraking = (msg.data[0]<<3)+(msg.data[1]>>5);
TickTock 73:62ee8eae3a84 315 targetBraking = (msg.data[2]<<3)+(msg.data[3]>>5);
TickTock 73:62ee8eae3a84 316
TickTock 73:62ee8eae3a84 317 if (targetBraking<2045){
TickTock 73:62ee8eae3a84 318 if ((targetBraking>50)&&(regenBraking>50)){
TickTock 73:62ee8eae3a84 319 temp = targetBraking;
TickTock 73:62ee8eae3a84 320 temp *= 1000;
TickTock 73:62ee8eae3a84 321 temp /= regenBraking;
TickTock 73:62ee8eae3a84 322 if (temp<tardivreg_x1000) tardivreg_x1000=temp;
TickTock 73:62ee8eae3a84 323 }
TickTock 73:62ee8eae3a84 324 if (targetBraking>maxTarget) maxTarget=targetBraking;
TickTock 73:62ee8eae3a84 325 if (regenBraking>maxRegen) maxRegen=regenBraking;
TickTock 73:62ee8eae3a84 326 temp = targetBraking;
TickTock 73:62ee8eae3a84 327 temp *=200;
TickTock 73:62ee8eae3a84 328 temp /= maxTarget;
TickTock 73:62ee8eae3a84 329 t = (char) temp;
TickTock 73:62ee8eae3a84 330 if (t>200) t=200;
TickTock 73:62ee8eae3a84 331 temp = regenBraking;
TickTock 73:62ee8eae3a84 332 temp *= tardivreg_x1000;
TickTock 73:62ee8eae3a84 333 temp /= maxTarget;
TickTock 73:62ee8eae3a84 334 temp /= 5; // 1000/200=5
TickTock 73:62ee8eae3a84 335 r = (char) temp;
TickTock 73:62ee8eae3a84 336 if (r>200) r=200;
TickTock 73:62ee8eae3a84 337 if(lr!=r&&prdata){
TickTock 73:62ee8eae3a84 338 tt.foreground(Yellow);
TickTock 73:62ee8eae3a84 339 tt.set_font((unsigned char*) Arial28x28);
TickTock 73:62ee8eae3a84 340 tt.locate(100,40);
TickTock 73:62ee8eae3a84 341 printf("%d %d \n",regenBraking,maxRegen);
TickTock 73:62ee8eae3a84 342 tt.locate(100,70);
TickTock 73:62ee8eae3a84 343 printf("%3.1f (%3.1f%s) \n",(float)tardivreg_x1000/10,(float)regenBraking*tardivreg_x1000/targetBraking/10,"%");
TickTock 73:62ee8eae3a84 344 }
TickTock 73:62ee8eae3a84 345 if(lt!=t&&prdata){
TickTock 73:62ee8eae3a84 346 tt.foreground(Yellow);
TickTock 73:62ee8eae3a84 347 tt.set_font((unsigned char*) Arial28x28);
TickTock 73:62ee8eae3a84 348 tt.locate(100,10);
TickTock 73:62ee8eae3a84 349 printf("%d %d \n",targetBraking,maxTarget);
TickTock 73:62ee8eae3a84 350 }
TickTock 73:62ee8eae3a84 351 if (r>t) t=r; //Should never happen
TickTock 73:62ee8eae3a84 352 if((lr!=r||lt!=t)&&!prdata){
TickTock 73:62ee8eae3a84 353 tt.fillrect(190,10,260,239-t,Navy);
TickTock 73:62ee8eae3a84 354 tt.fillrect(190,239-t,260,239-r,Red);
TickTock 73:62ee8eae3a84 355 tt.fillrect(190,239-r,260,239,Green);
TickTock 73:62ee8eae3a84 356 }
TickTock 73:62ee8eae3a84 357 lt=t;
TickTock 73:62ee8eae3a84 358 lr=r;
TickTock 28:f24ac05645d9 359 }
TickTock 28:f24ac05645d9 360 }
TickTock 28:f24ac05645d9 361
TickTock 42:4533b13b297d 362 void cpData(bool force, bool showButtons){
TickTock 36:dbd39c315258 363 short unsigned max, min, jv, i, bd;
TickTock 36:dbd39c315258 364 unsigned avg;
TickTock 97:a25940fd7b5b 365 static char step=0; // counter to allow incremental update
TickTock 36:dbd39c315258 366 if(force){
TickTock 36:dbd39c315258 367 tt.foreground(White);
TickTock 36:dbd39c315258 368 tt.background(Navy);
TickTock 36:dbd39c315258 369 tt.set_font((unsigned char*) Arial12x12_prop); // select the font
TickTock 36:dbd39c315258 370 max=0;
TickTock 36:dbd39c315258 371 min=9999;
TickTock 36:dbd39c315258 372 avg=0;
TickTock 92:935adef49ea4 373 for(i=0; i<96; i++){
TickTock 103:1389e9efe8c3 374 bd=(battData[BatDataBaseG2*7+i*2+3]<<8)+battData[BatDataBaseG2*7+i*2+4];
TickTock 36:dbd39c315258 375 avg+=bd;
TickTock 36:dbd39c315258 376 if(bd>max) max=bd;
TickTock 36:dbd39c315258 377 if(bd<min) min=bd;
TickTock 36:dbd39c315258 378 }
TickTock 36:dbd39c315258 379 avg /= 96;
TickTock 36:dbd39c315258 380 if(min<3713) {
TickTock 36:dbd39c315258 381 jv=avg-(max-avg)*1.5;
TickTock 36:dbd39c315258 382 } else { // Only compute judgement value if min cellpair meets <= 3712mV requirement
TickTock 36:dbd39c315258 383 jv=0;
TickTock 36:dbd39c315258 384 }
TickTock 99:c05abf8e1cdc 385
TickTock 107:e9be732c1ad4 386 char* sTemperatureUnit = temperatureUnit();
TickTock 97:a25940fd7b5b 387 switch(step){
TickTock 97:a25940fd7b5b 388 case 0:
TickTock 97:a25940fd7b5b 389 tt.cls();
TickTock 97:a25940fd7b5b 390 showCP=true;
TickTock 97:a25940fd7b5b 391 break;
TickTock 97:a25940fd7b5b 392 case 1:
TickTock 97:a25940fd7b5b 393 tt.locate(0,6);
TickTock 99:c05abf8e1cdc 394 printf(" MAX MIN AVG CVLI T1 T2 T3 T4\n %04d %04d %04d %04d %2.0f%s %2.0f%s %2.0f%s %2.0f%s\n\n",
TickTock 103:1389e9efe8c3 395 max,min,avg,jv, convertTemperature(battData[BatDataBaseG4*7+5]),sTemperatureUnit,convertTemperature(battData[BatDataBaseG4*7+8]),sTemperatureUnit,
TickTock 103:1389e9efe8c3 396 convertTemperature(battData[BatDataBaseG4*7+11]),sTemperatureUnit,convertTemperature(battData[BatDataBaseG4*7+14]),sTemperatureUnit);
TickTock 99:c05abf8e1cdc 397 //printf(" MAX MIN AVG CVLI T1 T2 T3 T4\n %04d %04d %04d %04d %02dC %02dC %02dC %02dC\n\n",
TickTock 103:1389e9efe8c3 398 // max,min,avg,jv, battData[BatDataBaseG4*7+5],battData[BatDataBaseG4*7+8],battData[BatDataBaseG4*7+11],battData[BatDataBaseG4*7+14]);
TickTock 97:a25940fd7b5b 399 tt.rect(8+0*41,16,40+0*41,28,Green);
TickTock 97:a25940fd7b5b 400 tt.rect(8+1*41,16,40+1*41,28,Yellow);
TickTock 97:a25940fd7b5b 401 //tt.rect(8+2*41,16,40+2*41,28,White);
TickTock 97:a25940fd7b5b 402 tt.rect(8+3*41,16,40+3*41,28,Red);
TickTock 97:a25940fd7b5b 403 break;
TickTock 97:a25940fd7b5b 404 default:
TickTock 97:a25940fd7b5b 405 tt.locate(0,36+(step-2)*48);
TickTock 97:a25940fd7b5b 406 for(i=(step-2)*4; i<(step-1)*4; i++){
TickTock 97:a25940fd7b5b 407 printf("%02d-%02d : %04d %04d %04d %04d %04d %04d\n",
TickTock 97:a25940fd7b5b 408 i*6+1,i*6+6,
TickTock 103:1389e9efe8c3 409 (battData[BatDataBaseG2*7+i*12+3]<<8)+battData[BatDataBaseG2*7+i*12+4],(battData[BatDataBaseG2*7+i*12+5]<<8)+battData[BatDataBaseG2*7+i*12+6],
TickTock 103:1389e9efe8c3 410 (battData[BatDataBaseG2*7+i*12+7]<<8)+battData[BatDataBaseG2*7+i*12+8],(battData[BatDataBaseG2*7+i*12+9]<<8)+battData[BatDataBaseG2*7+i*12+10],
TickTock 103:1389e9efe8c3 411 (battData[BatDataBaseG2*7+i*12+11]<<8)+battData[BatDataBaseG2*7+i*12+12],(battData[BatDataBaseG2*7+i*12+13]<<8)+battData[BatDataBaseG2*7+i*12+14]);
TickTock 97:a25940fd7b5b 412 }
TickTock 97:a25940fd7b5b 413 for(i=(step-2)*24; i<(step-1)*24; i++){
TickTock 103:1389e9efe8c3 414 bd=(battData[BatDataBaseG2*7+i*2+3]<<8)+battData[BatDataBaseG2*7+i*2+4];
TickTock 97:a25940fd7b5b 415 if(bd>0){
TickTock 97:a25940fd7b5b 416 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 97:a25940fd7b5b 417 //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 97:a25940fd7b5b 418 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 97:a25940fd7b5b 419 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 97:a25940fd7b5b 420 }
TickTock 97:a25940fd7b5b 421 }
TickTock 36:dbd39c315258 422 }
TickTock 97:a25940fd7b5b 423 step=step<5?step+1:0;
TickTock 97:a25940fd7b5b 424 if(step==0){
TickTock 97:a25940fd7b5b 425 showCP=false;
TickTock 36:dbd39c315258 426 }
TickTock 36:dbd39c315258 427 }
TickTock 42:4533b13b297d 428 if((sMode==1)&&showButtons){
TickTock 36:dbd39c315258 429 tt.foreground(Yellow);
TickTock 36:dbd39c315258 430 tt.background(DarkCyan);
TickTock 36:dbd39c315258 431 tt.set_font((unsigned char*) Arial12x12);
garygid 54:6ce808d0995e 432
garygid 54:6ce808d0995e 433 showButton(1,0,"Request","CP Data",4,4);
TickTock 44:6262a9fd1e56 434 }
TickTock 44:6262a9fd1e56 435 }
TickTock 44:6262a9fd1e56 436
TickTock 44:6262a9fd1e56 437 //----------------
garygid 67:2022fce701d0 438 // gg - index
garygid 67:2022fce701d0 439 void showIndex(bool force, bool showButtons){
garygid 67:2022fce701d0 440
garygid 67:2022fce701d0 441 if(force){
garygid 67:2022fce701d0 442 tt.foreground(White);
garygid 67:2022fce701d0 443 tt.background(Navy);
garygid 67:2022fce701d0 444 //tt.set_font((unsigned char*) Arial12x12_prop); // select the font
garygid 67:2022fce701d0 445
garygid 67:2022fce701d0 446 tt.cls();
garygid 67:2022fce701d0 447
garygid 67:2022fce701d0 448 // add the buttons to GoTo to other screens
garygid 67:2022fce701d0 449
garygid 67:2022fce701d0 450 tt.foreground(Yellow);
garygid 67:2022fce701d0 451 tt.background(DarkCyan);
garygid 67:2022fce701d0 452 tt.set_font((unsigned char*) Arial12x12);
garygid 67:2022fce701d0 453
garygid 67:2022fce701d0 454 // top row
garygid 67:2022fce701d0 455 showButton(0,0," GoTo"," Main",4,4);
garygid 67:2022fce701d0 456 showButton(1,0," GoTo"," Brake",4,4);
garygid 67:2022fce701d0 457 showButton(2,0," GoTo"," EFF",4,4);
garygid 67:2022fce701d0 458 showButton(3,0," GoTo"," DTE",4,4);
garygid 67:2022fce701d0 459 // middle row
garygid 67:2022fce701d0 460 showButton(0,1," GoTo","CP Data",4,4);
garygid 67:2022fce701d0 461 showButton(1,1," GoTo","CP Hist",4,4);
garygid 67:2022fce701d0 462 showButton(2,1," GoTo","CP Bars",4,4);
leafman 98:9f8bab96edff 463 showButton(3,1," GoTo"," Config",4,4);
leafman 98:9f8bab96edff 464 // bottom (not Nav) row
leafman 98:9f8bab96edff 465 showButton(0,2," GoTo","Playback",4,4);
leafman 98:9f8bab96edff 466 showButton(1,2," GoTo","Set Time",4,4);
leafman 98:9f8bab96edff 467 showButton(2,2," GoTo"," Log",4,4);
garygid 67:2022fce701d0 468
garygid 67:2022fce701d0 469 showCP=false;
garygid 67:2022fce701d0 470 }
garygid 67:2022fce701d0 471
garygid 67:2022fce701d0 472 if(sMode==1&&showButtons){
garygid 67:2022fce701d0 473 tt.foreground(Yellow);
garygid 67:2022fce701d0 474 tt.background(DarkCyan);
garygid 67:2022fce701d0 475 tt.set_font((unsigned char*) Arial12x12);
garygid 67:2022fce701d0 476
garygid 67:2022fce701d0 477 // do nothing here?
garygid 67:2022fce701d0 478 }
garygid 67:2022fce701d0 479 }
garygid 67:2022fce701d0 480
garygid 67:2022fce701d0 481 //----------------
TickTock 48:d1ce92104a1f 482 // gg - cpbars
TickTock 48:d1ce92104a1f 483 void cpBarPlot(bool force, bool showButtons){
TickTock 48:d1ce92104a1f 484 short unsigned max, min, jv, i, bd;
TickTock 48:d1ce92104a1f 485 unsigned avg;
TickTock 48:d1ce92104a1f 486 short unsigned nBar[96] ; // bar height over min
TickTock 48:d1ce92104a1f 487
TickTock 48:d1ce92104a1f 488 if(force){
TickTock 48:d1ce92104a1f 489 tt.foreground(White);
TickTock 48:d1ce92104a1f 490 tt.background(Navy);
TickTock 48:d1ce92104a1f 491 tt.set_font((unsigned char*) Arial12x12_prop); // select the font
TickTock 48:d1ce92104a1f 492 max=0;
TickTock 48:d1ce92104a1f 493 min=9999;
TickTock 48:d1ce92104a1f 494 avg=0;
TickTock 48:d1ce92104a1f 495
TickTock 48:d1ce92104a1f 496 // calc each cell-pair voltage, find max and min
TickTock 92:935adef49ea4 497 for(i=0; i<96; i++){
TickTock 103:1389e9efe8c3 498 bd=(battData[BatDataBaseG2*7+i*2+3]<<8)+battData[BatDataBaseG2*7+i*2+4];
TickTock 48:d1ce92104a1f 499 nBar[i] = bd; // init to bar height
TickTock 48:d1ce92104a1f 500 avg+=bd;
TickTock 48:d1ce92104a1f 501 if(bd>max) max=bd;
TickTock 48:d1ce92104a1f 502 if(bd<min) min=bd;
TickTock 48:d1ce92104a1f 503 }
TickTock 48:d1ce92104a1f 504 avg /= 96;
TickTock 48:d1ce92104a1f 505
TickTock 48:d1ce92104a1f 506 if(min<3713) {
TickTock 48:d1ce92104a1f 507 jv=avg-(max-avg)*1.5;
TickTock 48:d1ce92104a1f 508 } else { // Only compute judgement value if min cellpair meets <= 3712mV requirement
TickTock 48:d1ce92104a1f 509 jv=0;
TickTock 48:d1ce92104a1f 510 }
TickTock 48:d1ce92104a1f 511
TickTock 48:d1ce92104a1f 512 //------------------
TickTock 48:d1ce92104a1f 513 tt.cls();
TickTock 48:d1ce92104a1f 514
TickTock 48:d1ce92104a1f 515 // show as vertical bar plot
TickTock 48:d1ce92104a1f 516 int xWinMin = 26;
TickTock 48:d1ce92104a1f 517 int xWinMax = 316;
TickTock 48:d1ce92104a1f 518 int yWinMin = 50;
TickTock 48:d1ce92104a1f 519 int yWinMax = 150;
TickTock 48:d1ce92104a1f 520 // draw the Bar Graph Frame, 2 pixels wide
TickTock 48:d1ce92104a1f 521 tt.rect( xWinMin-1,yWinMin-1, xWinMax+1,yWinMax+1,Red);
TickTock 48:d1ce92104a1f 522 tt.rect( xWinMin-2,yWinMin-2, xWinMax+2,yWinMax+2,Green);
TickTock 48:d1ce92104a1f 523
TickTock 48:d1ce92104a1f 524 // bar heights
TickTock 48:d1ce92104a1f 525 int height = yWinMax - yWinMin ;
TickTock 48:d1ce92104a1f 526 int iBarValMax = max - min ; // zero to N
TickTock 48:d1ce92104a1f 527
TickTock 48:d1ce92104a1f 528 //----------------
TickTock 48:d1ce92104a1f 529 if( iBarValMax == 0 ) {
TickTock 48:d1ce92104a1f 530 // for testing
TickTock 48:d1ce92104a1f 531 min = 3501 ;
TickTock 48:d1ce92104a1f 532 //max = min + 95*2 ; // for tall values
TickTock 48:d1ce92104a1f 533 max = min + 95/4 ; // for small values
TickTock 48:d1ce92104a1f 534 avg = ( max + min ) / 2;
TickTock 48:d1ce92104a1f 535 iBarValMax = max - min ; // zero to N
TickTock 92:935adef49ea4 536 for(int i=0; i<96; i++) {
TickTock 48:d1ce92104a1f 537 //nBar[i] = i*2 + min ; // test tall values
TickTock 48:d1ce92104a1f 538 nBar[i] = i/4 + min ; // test small values
TickTock 48:d1ce92104a1f 539 }
TickTock 48:d1ce92104a1f 540 }
TickTock 48:d1ce92104a1f 541 //---------------
TickTock 48:d1ce92104a1f 542 float nBarScale = float(height) / iBarValMax ;
TickTock 48:d1ce92104a1f 543 if( nBarScale < 0.1 ) nBarScale = 0.1 ;
TickTock 48:d1ce92104a1f 544
TickTock 48:d1ce92104a1f 545 // do the Bar-height scaling
TickTock 92:935adef49ea4 546 for(int i=0; i<96; i++){
TickTock 48:d1ce92104a1f 547 nBar[i] -= min ; // now, 0 to N = iBinValMax
TickTock 48:d1ce92104a1f 548 nBar[i] *= nBarScale ; // scale, as needed
TickTock 48:d1ce92104a1f 549 }
TickTock 48:d1ce92104a1f 550
TickTock 48:d1ce92104a1f 551 // values, for now
TickTock 102:fd19f777a0b4 552 // BatDataBaseG4 * 7 = 280
TickTock 48:d1ce92104a1f 553 tt.locate( 0, yWinMax+40 );
TickTock 48:d1ce92104a1f 554 printf(" MAX MIN AVG CVLI T1 T2 T3 T4\n %04d %04d %04d %04d %02dC %02dC %02dC %02dC\n\n",
TickTock 103:1389e9efe8c3 555 max,min,avg,jv, battData[BatDataBaseG4*7+5],battData[BatDataBaseG4*7+8], battData[BatDataBaseG4*7+11],battData[BatDataBaseG4*7+14]);
TickTock 48:d1ce92104a1f 556
TickTock 48:d1ce92104a1f 557 // label the X axis (approximate)
TickTock 48:d1ce92104a1f 558 tt.locate( 2, yWinMax+5); printf("%04d", min );
TickTock 48:d1ce92104a1f 559 //tt.locate( 2, yWinMin-14 ); printf("%04d = %04d from %1.4f", max, int( height / nBarScale ) + min, nBarScale );
TickTock 48:d1ce92104a1f 560 tt.locate( 2, yWinMin-14 ); printf("%04d = (%d) mv range.", max , max - min );
TickTock 48:d1ce92104a1f 561
TickTock 48:d1ce92104a1f 562 //---------------
TickTock 48:d1ce92104a1f 563 // show the bars
TickTock 48:d1ce92104a1f 564 int nBarWidth = 2 ;
TickTock 48:d1ce92104a1f 565 int nBarSpace = 1 ; // 1 for testing
TickTock 48:d1ce92104a1f 566
TickTock 48:d1ce92104a1f 567 int xPos = xWinMin + 2 ; // start one from the left
TickTock 48:d1ce92104a1f 568
TickTock 92:935adef49ea4 569 for( int i=0; i<96; i++) {
TickTock 48:d1ce92104a1f 570 height = nBar[i] ;
TickTock 48:d1ce92104a1f 571 if( height > 100 ) height = 100 ; // clip tops
TickTock 48:d1ce92104a1f 572
TickTock 48:d1ce92104a1f 573 // draw the bar, is always inside x-window
TickTock 48:d1ce92104a1f 574 tt.fillrect( xPos,yWinMax-height, xPos+nBarWidth-1,yWinMax, Green);
TickTock 48:d1ce92104a1f 575
TickTock 48:d1ce92104a1f 576 // tic mark the y axis each 5
TickTock 48:d1ce92104a1f 577 if(i%5 == 4){
TickTock 48:d1ce92104a1f 578 tt.line( xPos,yWinMax+2, xPos,yWinMax+5, White); // a white tick mark
TickTock 48:d1ce92104a1f 579 tt.line( xPos+1,yWinMax+2, xPos+1,yWinMax+5, White); // a white tick mark, to widen
TickTock 48:d1ce92104a1f 580 //tt.rect( xPos,yWinMax+2, xPos+1,yWinMax+5, White); // a white 2-wide tick mark is SLOW
TickTock 48:d1ce92104a1f 581 }
TickTock 48:d1ce92104a1f 582 // label the y axis each 10
TickTock 48:d1ce92104a1f 583 if(i%10 == 9){
TickTock 48:d1ce92104a1f 584 tt.locate( xPos-6, yWinMax+8 );
TickTock 48:d1ce92104a1f 585 printf("%02d\n", i+1 );
TickTock 48:d1ce92104a1f 586 }
TickTock 48:d1ce92104a1f 587
TickTock 48:d1ce92104a1f 588 // step to the next bar position
TickTock 48:d1ce92104a1f 589 xPos += nBarWidth + nBarSpace ;
TickTock 48:d1ce92104a1f 590 }
TickTock 48:d1ce92104a1f 591
TickTock 48:d1ce92104a1f 592 showCP=false;
TickTock 48:d1ce92104a1f 593 }
TickTock 48:d1ce92104a1f 594
TickTock 48:d1ce92104a1f 595 // handle the button
TickTock 48:d1ce92104a1f 596 if(sMode==1&&showButtons){
TickTock 48:d1ce92104a1f 597 tt.foreground(Yellow);
TickTock 48:d1ce92104a1f 598 tt.background(DarkCyan);
TickTock 48:d1ce92104a1f 599 tt.set_font((unsigned char*) Arial12x12);
garygid 54:6ce808d0995e 600
garygid 54:6ce808d0995e 601 showButton(1,0,"Request","CP Data",4,4);
TickTock 48:d1ce92104a1f 602 }
TickTock 48:d1ce92104a1f 603 }
TickTock 48:d1ce92104a1f 604
TickTock 48:d1ce92104a1f 605 //----------------
TickTock 44:6262a9fd1e56 606 // gg - hist
TickTock 47:9cc7d876dd6d 607 void cpHistogram(bool force, bool showButtons){
TickTock 44:6262a9fd1e56 608 short unsigned max, min, jv, i, bd;
TickTock 44:6262a9fd1e56 609 unsigned avg;
TickTock 44:6262a9fd1e56 610 if(force){
TickTock 44:6262a9fd1e56 611 tt.foreground(White);
TickTock 44:6262a9fd1e56 612 tt.background(Navy);
TickTock 44:6262a9fd1e56 613 tt.set_font((unsigned char*) Arial12x12_prop); // select the font
TickTock 44:6262a9fd1e56 614 max=0;
TickTock 44:6262a9fd1e56 615 min=9999;
TickTock 44:6262a9fd1e56 616 avg=0;
TickTock 92:935adef49ea4 617 for(i=0; i<96; i++){
TickTock 103:1389e9efe8c3 618 bd=(battData[BatDataBaseG2*7+i*2+3]<<8)+battData[BatDataBaseG2*7+i*2+4];
TickTock 44:6262a9fd1e56 619 avg+=bd;
TickTock 44:6262a9fd1e56 620 if(bd>max) max=bd;
TickTock 44:6262a9fd1e56 621 if(bd<min) min=bd;
TickTock 44:6262a9fd1e56 622 }
TickTock 44:6262a9fd1e56 623 avg /= 96;
TickTock 44:6262a9fd1e56 624 if(min<3713) {
TickTock 44:6262a9fd1e56 625 jv=avg-(max-avg)*1.5;
TickTock 44:6262a9fd1e56 626 } else { // Only compute judgement value if min cellpair meets <= 3712mV requirement
TickTock 44:6262a9fd1e56 627 jv=0;
TickTock 44:6262a9fd1e56 628 }
TickTock 44:6262a9fd1e56 629
TickTock 44:6262a9fd1e56 630 //------------------
TickTock 44:6262a9fd1e56 631 tt.cls();
TickTock 44:6262a9fd1e56 632
TickTock 44:6262a9fd1e56 633 // show as histogram
TickTock 44:6262a9fd1e56 634 int xWinMin = 20;
TickTock 44:6262a9fd1e56 635 int xWinMax = 300;
TickTock 44:6262a9fd1e56 636 int yWinMin = 50;
TickTock 44:6262a9fd1e56 637 int yWinMax = 150;
TickTock 44:6262a9fd1e56 638 // draw the Histogram Frame, 2 pixels wide
TickTock 44:6262a9fd1e56 639 tt.rect( xWinMin-1,yWinMin-1, xWinMax+1,yWinMax+1,Red);
TickTock 44:6262a9fd1e56 640 tt.rect( xWinMin-2,yWinMin-2, xWinMax+2,yWinMax+2,Green);
TickTock 44:6262a9fd1e56 641
TickTock 44:6262a9fd1e56 642 // binning
TickTock 44:6262a9fd1e56 643 short nBin[301] ; // bins to count Min values in nBin[0], etc.
TickTock 44:6262a9fd1e56 644 int height ;
TickTock 44:6262a9fd1e56 645 int iBinIndxMax = 300 ;
TickTock 44:6262a9fd1e56 646 int iBinValMax = max - min ; // zero to N
TickTock 44:6262a9fd1e56 647 if( iBinValMax > iBinIndxMax ) iBinValMax = iBinIndxMax ;
TickTock 44:6262a9fd1e56 648
TickTock 44:6262a9fd1e56 649 // clean the bins
TickTock 92:935adef49ea4 650 for(int i=0; i<=iBinIndxMax; i++) {
TickTock 44:6262a9fd1e56 651 nBin[i] = 0;
TickTock 44:6262a9fd1e56 652 }
TickTock 44:6262a9fd1e56 653
TickTock 44:6262a9fd1e56 654 // do the bin counting
TickTock 92:935adef49ea4 655 for(int i=0; i<96; i++){
TickTock 103:1389e9efe8c3 656 bd=(battData[BatDataBaseG2*7+i*2+3]<<8)+battData[BatDataBaseG2*7+i*2+4] - min ;
TickTock 44:6262a9fd1e56 657 if( bd > iBinValMax ) bd = iBinValMax ;
TickTock 92:935adef49ea4 658 nBin[bd] ++ ;
TickTock 44:6262a9fd1e56 659 }
TickTock 44:6262a9fd1e56 660
TickTock 44:6262a9fd1e56 661 //----------------
TickTock 44:6262a9fd1e56 662 if( iBinValMax == 0 ) {
TickTock 44:6262a9fd1e56 663 // for testing
TickTock 44:6262a9fd1e56 664 min = 10 ;
TickTock 44:6262a9fd1e56 665 max = 50 ;
TickTock 44:6262a9fd1e56 666 avg = ( max + min ) / 2;
TickTock 44:6262a9fd1e56 667 iBinValMax = max - min ;
TickTock 92:935adef49ea4 668 for(int i=0; i<=(iBinValMax/2); i++) {
TickTock 44:6262a9fd1e56 669 nBin[i] = i ;
TickTock 44:6262a9fd1e56 670 nBin[iBinValMax-i] = i ;
TickTock 44:6262a9fd1e56 671 }
TickTock 44:6262a9fd1e56 672 }
TickTock 44:6262a9fd1e56 673
TickTock 48:d1ce92104a1f 674 // the values, for now
TickTock 102:fd19f777a0b4 675 // BatDataBaseG4 * 7 = 280
TickTock 48:d1ce92104a1f 676 tt.locate( 0, yWinMax+40 );
garygid 87:46ac3f2519d6 677 printf(" MAX MIN AVG CVLI T1 T2 T3 T4\n %04d %04d %04d %04d %02dC %02dC %02dC %02dC\n\n",
TickTock 103:1389e9efe8c3 678 max,min,avg,jv, battData[BatDataBaseG2*7+BatDataBaseG4*7+5],battData[BatDataBaseG2*7+BatDataBaseG4*7+8], battData[BatDataBaseG2*7+BatDataBaseG4*7+11],battData[BatDataBaseG2*7+BatDataBaseG4*7+14]);
TickTock 48:d1ce92104a1f 679
TickTock 44:6262a9fd1e56 680 //---------------
TickTock 44:6262a9fd1e56 681 // show the bars
TickTock 44:6262a9fd1e56 682 int nBarWidth = 3 ;
TickTock 44:6262a9fd1e56 683 int nBarSpace = 1 ; // 1 for testing
TickTock 44:6262a9fd1e56 684
TickTock 44:6262a9fd1e56 685 int xPos = (xWinMin + xWinMax) / 2 ;
TickTock 44:6262a9fd1e56 686 xPos -= (avg-min) * (nBarWidth + nBarSpace) ;
TickTock 44:6262a9fd1e56 687
TickTock 92:935adef49ea4 688 for( int i=0; i<=iBinValMax; i++) {
TickTock 44:6262a9fd1e56 689 height = 4 * nBin[i] ;
TickTock 44:6262a9fd1e56 690 if( height > 100 ) height = 100 ; // clip tops
TickTock 44:6262a9fd1e56 691
TickTock 44:6262a9fd1e56 692 // if inside the window, draw the bar
TickTock 44:6262a9fd1e56 693 if( ( xPos + nBarWidth < xWinMax ) && ( xPos > xWinMin ) )
TickTock 44:6262a9fd1e56 694 tt.fillrect( xPos,yWinMax-height, xPos+nBarWidth-1,yWinMax, Green);
TickTock 44:6262a9fd1e56 695
TickTock 44:6262a9fd1e56 696 // step to the next bar position
TickTock 44:6262a9fd1e56 697 xPos += nBarWidth + nBarSpace ;
TickTock 44:6262a9fd1e56 698 }
TickTock 44:6262a9fd1e56 699
TickTock 44:6262a9fd1e56 700 showCP=false;
TickTock 44:6262a9fd1e56 701 }
TickTock 44:6262a9fd1e56 702
TickTock 44:6262a9fd1e56 703 // handle the button
TickTock 47:9cc7d876dd6d 704 if(sMode==1&&showButtons){
TickTock 44:6262a9fd1e56 705 tt.foreground(Yellow);
TickTock 44:6262a9fd1e56 706 tt.background(DarkCyan);
TickTock 44:6262a9fd1e56 707 tt.set_font((unsigned char*) Arial12x12);
garygid 54:6ce808d0995e 708
garygid 54:6ce808d0995e 709 showButton(1,0,"Request","CP Data",4,4);
garygid 54:6ce808d0995e 710 }
TickTock 36:dbd39c315258 711 }
TickTock 36:dbd39c315258 712
TickTock 48:d1ce92104a1f 713 //---------------
leafman 98:9f8bab96edff 714 void config(bool force, bool showButtons){
TickTock 36:dbd39c315258 715 if (force) {
TickTock 36:dbd39c315258 716 tt.background(Black);
TickTock 36:dbd39c315258 717 tt.cls();
TickTock 36:dbd39c315258 718 }
TickTock 36:dbd39c315258 719 tt.foreground(Yellow);
TickTock 36:dbd39c315258 720 tt.background(DarkCyan);
TickTock 36:dbd39c315258 721 tt.set_font((unsigned char*) Arial12x12);
garygid 54:6ce808d0995e 722
garygid 65:821fc79cd7fe 723 //-------- top row --------
garygid 54:6ce808d0995e 724 showButton(0,0,"Calibrate"," Touch",4,4); // gg - 4x4
garygid 54:6ce808d0995e 725 showButton(1,0," Reset","",4,4);
garygid 65:821fc79cd7fe 726 showButton(2,0," Save"," Config",4,4);
garygid 65:821fc79cd7fe 727
garygid 65:821fc79cd7fe 728 // a button to step to the next skin
garygid 65:821fc79cd7fe 729 unsigned int nextSkin = skin + 1 ;
garygid 65:821fc79cd7fe 730 if( nextSkin > maxSkin ) nextSkin = 0 ;
garygid 54:6ce808d0995e 731
garygid 65:821fc79cd7fe 732 if( nextSkin == ttSkin ) sprintf(sTemp1,"Skin TT");
garygid 65:821fc79cd7fe 733 else if( nextSkin == ggSkin ) sprintf(sTemp1,"Skin GG");
garygid 65:821fc79cd7fe 734 else sprintf(sTemp1,"Skin %d",nextSkin);
garygid 65:821fc79cd7fe 735
garygid 65:821fc79cd7fe 736 showButton(3,0," Use",sTemp1,4,4);
TickTock 48:d1ce92104a1f 737
TickTock 48:d1ce92104a1f 738 //------- second row -----
TickTock 36:dbd39c315258 739 if (logEn) {
garygid 54:6ce808d0995e 740 sprintf(sTemp1,"Disable");
TickTock 36:dbd39c315258 741 } else {
garygid 54:6ce808d0995e 742 sprintf(sTemp1,"Enable");
TickTock 36:dbd39c315258 743 }
garygid 54:6ce808d0995e 744 showButton(0,1,sTemp1,"Logging",4,4);
TickTock 48:d1ce92104a1f 745
TickTock 36:dbd39c315258 746 if (repeatPoll) {
garygid 54:6ce808d0995e 747 sprintf(sTemp1,"Disable");
TickTock 36:dbd39c315258 748 } else {
garygid 54:6ce808d0995e 749 sprintf(sTemp1,"Enable");
TickTock 36:dbd39c315258 750 }
garygid 54:6ce808d0995e 751 showButton(1,1,sTemp1,"Auto CP",4,4);
TickTock 48:d1ce92104a1f 752
TickTock 48:d1ce92104a1f 753 // add Enable/Disable Batt Log gg - yesBattLog
TickTock 48:d1ce92104a1f 754 if (yesBattLog) {
garygid 54:6ce808d0995e 755 sprintf(sTemp1,"Disable");
TickTock 48:d1ce92104a1f 756 } else {
garygid 54:6ce808d0995e 757 sprintf(sTemp1,"Enable");
TickTock 48:d1ce92104a1f 758 }
garygid 54:6ce808d0995e 759 showButton(2,1,sTemp1,"Batt Log",4,4);
garygid 87:46ac3f2519d6 760
garygid 87:46ac3f2519d6 761 // add Enable/Disable Debug - debugMode
garygid 87:46ac3f2519d6 762 if (debugMode) {
garygid 87:46ac3f2519d6 763 sprintf(sTemp1,"Disable");
garygid 87:46ac3f2519d6 764 } else {
garygid 87:46ac3f2519d6 765 sprintf(sTemp1,"Enable");
garygid 87:46ac3f2519d6 766 }
garygid 87:46ac3f2519d6 767 showButton(3,1,sTemp1," Debug",4,4);
leafman 98:9f8bab96edff 768
leafman 98:9f8bab96edff 769 if(metric)
leafman 98:9f8bab96edff 770 showButton(0,2,"Imperial","",4,4);
leafman 98:9f8bab96edff 771 else
leafman 98:9f8bab96edff 772 showButton(0,2,"Metric","",4,4);
leafman 98:9f8bab96edff 773
leafman 98:9f8bab96edff 774 showButton(3,2,"Update","Firmware",4,4);
leafman 98:9f8bab96edff 775
TickTock 36:dbd39c315258 776 }
TickTock 36:dbd39c315258 777
TickTock 42:4533b13b297d 778 void pbScreen(bool force, bool showButtons){
TickTock 36:dbd39c315258 779 if (force) {
TickTock 36:dbd39c315258 780 tt.background(Black);
TickTock 36:dbd39c315258 781 tt.cls();
TickTock 36:dbd39c315258 782 }
TickTock 36:dbd39c315258 783 tt.foreground(Yellow);
TickTock 36:dbd39c315258 784 tt.background(DarkCyan);
TickTock 36:dbd39c315258 785 tt.set_font((unsigned char*) Arial12x12);
TickTock 36:dbd39c315258 786 if(playbackOpen){
garygid 54:6ce808d0995e 787 showButton(0,0,"Slower"," <--",4,4);
garygid 54:6ce808d0995e 788
TickTock 36:dbd39c315258 789 if(playbackEn){
garygid 54:6ce808d0995e 790 sprintf(sTemp1,"Pause");
TickTock 36:dbd39c315258 791 }else{
garygid 54:6ce808d0995e 792 sprintf(sTemp1," Run");
TickTock 36:dbd39c315258 793 }
garygid 54:6ce808d0995e 794 sprintf(sTemp2,"%4.3f ",playbackInt);
garygid 54:6ce808d0995e 795 showButton(1,0,sTemp1,sTemp2,4,4);
garygid 54:6ce808d0995e 796
garygid 54:6ce808d0995e 797 showButton(2,0,"Faster"," -->",4,4);
TickTock 36:dbd39c315258 798 }
TickTock 36:dbd39c315258 799 if(playbackOpen){
TickTock 36:dbd39c315258 800 sprintf(sTemp1," Stop");
TickTock 36:dbd39c315258 801 }else{
garygid 54:6ce808d0995e 802 sprintf(sTemp1,"Start");
TickTock 36:dbd39c315258 803 }
garygid 54:6ce808d0995e 804 showButton(1,1,sTemp1,"Playback",4,4);
TickTock 36:dbd39c315258 805 }
TickTock 36:dbd39c315258 806
TickTock 42:4533b13b297d 807 void showDateTime(bool force, bool showButtons){
TickTock 36:dbd39c315258 808 struct tm t; // pointer to a static tm structure
TickTock 36:dbd39c315258 809 time_t seconds ;
TickTock 36:dbd39c315258 810 tt.foreground(Yellow);
TickTock 44:6262a9fd1e56 811 tt.background(Black);
TickTock 36:dbd39c315258 812 if (force) {
TickTock 36:dbd39c315258 813 tt.cls();
TickTock 36:dbd39c315258 814 seconds = time(NULL);
TickTock 36:dbd39c315258 815 t = *localtime(&seconds) ;
TickTock 36:dbd39c315258 816
TickTock 36:dbd39c315258 817 tt.locate(10,10);
TickTock 43:e7f6f80590e3 818 tt.set_font((unsigned char*) Arial12x12);
TickTock 36:dbd39c315258 819 strftime(sTemp1, 32, "%a %m/%d/%Y %X \n", &t);
TickTock 36:dbd39c315258 820 printf("%s",sTemp1);
TickTock 42:4533b13b297d 821 if((sMode==1)&&showButtons){
TickTock 36:dbd39c315258 822 switch(dtMode){
TickTock 36:dbd39c315258 823 case 0:
TickTock 36:dbd39c315258 824 sprintf(sTemp1,"Year");
TickTock 36:dbd39c315258 825 break;
TickTock 36:dbd39c315258 826 case 1:
TickTock 36:dbd39c315258 827 sprintf(sTemp1,"Month");
TickTock 36:dbd39c315258 828 break;
TickTock 36:dbd39c315258 829 case 2:
TickTock 36:dbd39c315258 830 sprintf(sTemp1,"Day");
TickTock 36:dbd39c315258 831 break;
TickTock 36:dbd39c315258 832 case 3:
TickTock 36:dbd39c315258 833 sprintf(sTemp1,"Hour");
TickTock 36:dbd39c315258 834 break;
TickTock 36:dbd39c315258 835 case 4:
TickTock 36:dbd39c315258 836 sprintf(sTemp1,"Minute");
TickTock 36:dbd39c315258 837 break;
TickTock 36:dbd39c315258 838 case 5:
TickTock 36:dbd39c315258 839 sprintf(sTemp1,"Second");
TickTock 36:dbd39c315258 840 break;
TickTock 36:dbd39c315258 841 case 6:
TickTock 36:dbd39c315258 842 sprintf(sTemp1,"Select");
TickTock 36:dbd39c315258 843 break;
TickTock 36:dbd39c315258 844 default:
TickTock 36:dbd39c315258 845 break;
TickTock 36:dbd39c315258 846 }
TickTock 44:6262a9fd1e56 847 tt.background(DarkCyan);
TickTock 66:b7476ce7a59e 848 showButton(0,1,sTemp1,"",4,4);
garygid 54:6ce808d0995e 849 showButton(1,1," UP","",4,4);
garygid 54:6ce808d0995e 850 showButton(2,1," DOWN","",4,4);
TickTock 36:dbd39c315258 851 }
TickTock 36:dbd39c315258 852 }
TickTock 36:dbd39c315258 853 }
TickTock 36:dbd39c315258 854
TickTock 50:83d5864c64a0 855 void dteDisplay(bool force, bool showButtons, bool showMiles){
TickTock 66:b7476ce7a59e 856 unsigned short i,x,y,lx,ly,gids,radius,color,r,t;
TickTock 83:52b1f330a62d 857 unsigned char toVal;
TickTock 50:83d5864c64a0 858 static unsigned short lgids=0;
TickTock 50:83d5864c64a0 859 static unsigned char leff[39]={0};
TickTock 50:83d5864c64a0 860 CANMessage msg;
TickTock 66:b7476ce7a59e 861 unsigned long targetBraking, regenBraking, temp;
TickTock 73:62ee8eae3a84 862 static unsigned long maxTarget = 1000, maxRegen = 1000, tardivreg_x1000 = 1000;
TickTock 66:b7476ce7a59e 863 static unsigned char lr=0, lt=0;
TickTock 50:83d5864c64a0 864
TickTock 50:83d5864c64a0 865 msg = lastMsg[indexLastMsg[0x5bc]]; //Get gids
TickTock 50:83d5864c64a0 866 gids = (msg.data[0]<<2)+(msg.data[1]>>6);
TickTock 50:83d5864c64a0 867 if(gids==0){
TickTock 83:52b1f330a62d 868 gids=281; // Display new, fully charged capacity until real data obtained
TickTock 50:83d5864c64a0 869 }
TickTock 50:83d5864c64a0 870
TickTock 37:fea2c1d52c5f 871 tt.background(Navy);
TickTock 49:a3d2c5bb3cfa 872 tt.foreground(Yellow);
TickTock 52:d5385fbf4ea1 873 if(force){
TickTock 97:a25940fd7b5b 874 tt.set_font((unsigned char*) Arial12x12);
TickTock 52:d5385fbf4ea1 875 tt.cls();
TickTock 49:a3d2c5bb3cfa 876 x=50+0*6;
TickTock 52:d5385fbf4ea1 877 tt.locate(x-10,226);
TickTock 49:a3d2c5bb3cfa 878 printf("sec\n");
TickTock 50:83d5864c64a0 879 tt.line(x,10,x,220,DarkGrey);
TickTock 49:a3d2c5bb3cfa 880 x=50+9*6;
TickTock 52:d5385fbf4ea1 881 tt.locate(x-10,226);
TickTock 49:a3d2c5bb3cfa 882 printf("min\n");
TickTock 50:83d5864c64a0 883 tt.line(x,10,x,220,DarkGrey);
TickTock 49:a3d2c5bb3cfa 884 x=50+18*6;
TickTock 52:d5385fbf4ea1 885 tt.locate(x-10,226);
TickTock 49:a3d2c5bb3cfa 886 printf("hour\n");
TickTock 83:52b1f330a62d 887 tt.line(x,10,x,220,DarkGrey);
TickTock 49:a3d2c5bb3cfa 888 x=50+25*6;
TickTock 52:d5385fbf4ea1 889 tt.locate(x-10,226);
TickTock 49:a3d2c5bb3cfa 890 printf("day\n");
TickTock 50:83d5864c64a0 891 tt.line(x,10,x,220,DarkGrey);
TickTock 49:a3d2c5bb3cfa 892 x=50+32*6;
TickTock 52:d5385fbf4ea1 893 tt.locate(x-10,226);
TickTock 49:a3d2c5bb3cfa 894 printf("mon\n");
TickTock 50:83d5864c64a0 895 tt.line(x,10,x,220,DarkGrey);
TickTock 49:a3d2c5bb3cfa 896 x=50+38*6;
TickTock 66:b7476ce7a59e 897 //tt.locate(x-10,226);
TickTock 66:b7476ce7a59e 898 //printf("year\n");
TickTock 66:b7476ce7a59e 899 //tt.line(x,10,x,220,DarkGrey);
TickTock 97:a25940fd7b5b 900 toVal=33;
TickTock 83:52b1f330a62d 901 } else {
TickTock 97:a25940fd7b5b 902 toVal=24;// no need to constantly update the long tc values
TickTock 50:83d5864c64a0 903 }
TickTock 83:52b1f330a62d 904 if(force||lgids!=gids){ // update Y axis when kWh changes
TickTock 97:a25940fd7b5b 905 //tt.set_font((unsigned char*) Arial12x12);
TickTock 97:a25940fd7b5b 906 tt.set_font((unsigned char*) Arial24x23);
TickTock 97:a25940fd7b5b 907 //for(i=0;i<10;i++){
TickTock 97:a25940fd7b5b 908 //y=200-i*20;
TickTock 97:a25940fd7b5b 909 for(i=3;i<8;i++){
TickTock 97:a25940fd7b5b 910 y=200-(i-3)*40;
TickTock 97:a25940fd7b5b 911 tt.locate(0,y-8);
TickTock 83:52b1f330a62d 912 if (showMiles){
leafman 98:9f8bab96edff 913 printf("%3.0f\n",convertDistance(i*((float)(gids-5)*.075))); // LM - Added metric support
TickTock 99:c05abf8e1cdc 914 //printf("%2.0f \n",i*((float)(gids-5)*.075));
TickTock 83:52b1f330a62d 915 }else{
TickTock 83:52b1f330a62d 916 printf("%d.0\n",i);
TickTock 50:83d5864c64a0 917 }
TickTock 97:a25940fd7b5b 918 tt.line(48,y,toVal*6+56,y,DarkGrey);
TickTock 83:52b1f330a62d 919 }
TickTock 83:52b1f330a62d 920 lgids=gids;
TickTock 83:52b1f330a62d 921 }
TickTock 84:fd21e5d32dab 922 if(updateDTE||force){
TickTock 97:a25940fd7b5b 923 for(i=3;i<8;i++){
TickTock 97:a25940fd7b5b 924 y=200-(i-3)*40;
TickTock 83:52b1f330a62d 925 tt.line(40,y,158,y,DarkGrey);
TickTock 50:83d5864c64a0 926 }
TickTock 50:83d5864c64a0 927
TickTock 50:83d5864c64a0 928 x=50+0*6;
TickTock 50:83d5864c64a0 929 tt.line(x,10,x,220,DarkGrey);
TickTock 50:83d5864c64a0 930 x=50+9*6;
TickTock 50:83d5864c64a0 931 tt.line(x,10,x,220,DarkGrey);
TickTock 50:83d5864c64a0 932 x=50+18*6;
TickTock 50:83d5864c64a0 933 tt.line(x,10,x,220,DarkGrey);
TickTock 83:52b1f330a62d 934 //x=50+25*6;
TickTock 83:52b1f330a62d 935 //tt.line(x,60,x,220,DarkGrey);
TickTock 83:52b1f330a62d 936 //x=50+32*6;
TickTock 83:52b1f330a62d 937 //tt.line(x,60,x,220,DarkGrey);
TickTock 66:b7476ce7a59e 938 //x=50+38*6;
TickTock 66:b7476ce7a59e 939 //tt.line(x,60,x,220,DarkGrey);
TickTock 50:83d5864c64a0 940 tt.set_font((unsigned char*) SCProSB31x55);
TickTock 50:83d5864c64a0 941 tt.foreground(Green);
TickTock 50:83d5864c64a0 942 if (showMiles){
TickTock 93:c2402e8cd0e2 943 float miles = mpkWh[dtePeriod]*((float)(gids-5)*.075);
leafman 98:9f8bab96edff 944 miles = convertDistance(miles); // LM - Metric support
TickTock 93:c2402e8cd0e2 945 // Right justify
TickTock 94:c3a14b3975d6 946 if (miles>99.9){ //space=18; num=31; . = 23
TickTock 94:c3a14b3975d6 947 tt.locate(161,8);
TickTock 94:c3a14b3975d6 948 printf("%4.1f\n",miles);
TickTock 93:c2402e8cd0e2 949 } else if (miles>9.9){
TickTock 94:c3a14b3975d6 950 tt.locate(156,8);
TickTock 94:c3a14b3975d6 951 printf(" %3.1f\n",miles);
TickTock 93:c2402e8cd0e2 952 } else {
TickTock 94:c3a14b3975d6 953 tt.locate(151,8);
TickTock 94:c3a14b3975d6 954 printf(" %2.1f\n",miles);
TickTock 93:c2402e8cd0e2 955 }
TickTock 97:a25940fd7b5b 956 tt.foreground(Cyan);
TickTock 97:a25940fd7b5b 957 tt.set_font((unsigned char*) Arial24x23);
TickTock 97:a25940fd7b5b 958 tt.locate(198,70);
TickTock 97:a25940fd7b5b 959 printf("%3.1f \n",mpkWh[dtePeriod]);
TickTock 50:83d5864c64a0 960 } else {
TickTock 97:a25940fd7b5b 961 tt.locate(200,10);
TickTock 66:b7476ce7a59e 962 printf("%3.1f \n",mpkWh[dtePeriod]);
TickTock 50:83d5864c64a0 963 }
TickTock 49:a3d2c5bb3cfa 964 lx=50;
TickTock 97:a25940fd7b5b 965 ly=mpkWh[0]*40;
TickTock 50:83d5864c64a0 966 if(dtePeriod==0){
TickTock 52:d5385fbf4ea1 967 radius=6;
TickTock 83:52b1f330a62d 968 color=Yellow;
TickTock 50:83d5864c64a0 969 }else{
TickTock 50:83d5864c64a0 970 radius=2;
TickTock 50:83d5864c64a0 971 color=Green;
TickTock 50:83d5864c64a0 972 }
TickTock 97:a25940fd7b5b 973 if(ly<100){
TickTock 97:a25940fd7b5b 974 ly=220;
TickTock 97:a25940fd7b5b 975 color=Red;
TickTock 97:a25940fd7b5b 976 }else if(ly<320) {
TickTock 97:a25940fd7b5b 977 ly=320-ly;
TickTock 97:a25940fd7b5b 978 }else{
TickTock 97:a25940fd7b5b 979 ly=0;
TickTock 97:a25940fd7b5b 980 }
TickTock 50:83d5864c64a0 981 tt.fillcircle(lx,leff[0],radius,Navy);
TickTock 50:83d5864c64a0 982 tt.fillcircle(lx,ly,radius,color);
TickTock 49:a3d2c5bb3cfa 983
TickTock 92:935adef49ea4 984 for(i=1;i<toVal;i++){
TickTock 49:a3d2c5bb3cfa 985 x=50+i*6;
TickTock 97:a25940fd7b5b 986 y=mpkWh[i]*40;
TickTock 50:83d5864c64a0 987 if(i==dtePeriod){
TickTock 83:52b1f330a62d 988 radius=6;
TickTock 83:52b1f330a62d 989 color=Yellow;
TickTock 50:83d5864c64a0 990 }else{
TickTock 50:83d5864c64a0 991 radius=2;
TickTock 50:83d5864c64a0 992 color=Green;
TickTock 50:83d5864c64a0 993 }
TickTock 97:a25940fd7b5b 994 if(y<100){
TickTock 97:a25940fd7b5b 995 y=220;
TickTock 97:a25940fd7b5b 996 color=Red;
TickTock 97:a25940fd7b5b 997 }else if(y<320) {
TickTock 97:a25940fd7b5b 998 y=320-y;
TickTock 97:a25940fd7b5b 999 }else{
TickTock 97:a25940fd7b5b 1000 y=0;
TickTock 97:a25940fd7b5b 1001 }
TickTock 50:83d5864c64a0 1002 tt.fillcircle(x,leff[i],radius,Navy);
TickTock 50:83d5864c64a0 1003 tt.line(x-6,leff[i-1],x,leff[i],Navy);
TickTock 50:83d5864c64a0 1004 leff[i-1]=ly;
TickTock 52:d5385fbf4ea1 1005 if(y>0){
TickTock 52:d5385fbf4ea1 1006 tt.fillcircle(x,y,radius,color);
TickTock 52:d5385fbf4ea1 1007 }
TickTock 49:a3d2c5bb3cfa 1008 tt.line(lx,ly,x,y,White);
TickTock 49:a3d2c5bb3cfa 1009 lx=x;
TickTock 49:a3d2c5bb3cfa 1010 ly=y;
TickTock 49:a3d2c5bb3cfa 1011 }
TickTock 50:83d5864c64a0 1012 leff[i-1]=y;
TickTock 50:83d5864c64a0 1013 updateDTE=false;
TickTock 37:fea2c1d52c5f 1014 }
TickTock 66:b7476ce7a59e 1015
TickTock 66:b7476ce7a59e 1016 msg = lastMsg[indexLastMsg[0x1cb]]; //Get Target and Regen
TickTock 66:b7476ce7a59e 1017 regenBraking = (msg.data[0]<<3)+(msg.data[1]>>5);
TickTock 66:b7476ce7a59e 1018 targetBraking = (msg.data[2]<<3)+(msg.data[3]>>5);
TickTock 73:62ee8eae3a84 1019
TickTock 73:62ee8eae3a84 1020 if (targetBraking<2045){
TickTock 73:62ee8eae3a84 1021 if ((targetBraking>50)&&(regenBraking>50)){
TickTock 73:62ee8eae3a84 1022 temp = targetBraking;
TickTock 73:62ee8eae3a84 1023 temp *= 1000;
TickTock 73:62ee8eae3a84 1024 temp /= regenBraking;
TickTock 73:62ee8eae3a84 1025 if (temp<tardivreg_x1000) tardivreg_x1000=temp;
TickTock 73:62ee8eae3a84 1026 }
TickTock 73:62ee8eae3a84 1027 if (targetBraking>maxTarget) maxTarget=targetBraking;
TickTock 73:62ee8eae3a84 1028 if (regenBraking>maxRegen) maxRegen=regenBraking;
TickTock 73:62ee8eae3a84 1029
TickTock 66:b7476ce7a59e 1030 temp = targetBraking;
TickTock 73:62ee8eae3a84 1031 temp *=200;
TickTock 73:62ee8eae3a84 1032 temp /= maxTarget;
TickTock 73:62ee8eae3a84 1033 t = (char) temp;
TickTock 73:62ee8eae3a84 1034 if (t>175) t=175;
TickTock 73:62ee8eae3a84 1035 temp = regenBraking;
TickTock 73:62ee8eae3a84 1036 temp *= tardivreg_x1000;
TickTock 73:62ee8eae3a84 1037 temp /= maxTarget;
TickTock 73:62ee8eae3a84 1038 temp /= 5; // 1000/200=5
TickTock 73:62ee8eae3a84 1039 r = (char) temp;
TickTock 73:62ee8eae3a84 1040 if (r>175) r=175;
TickTock 73:62ee8eae3a84 1041 if (r>t) t=r; //Should never happen
TickTock 73:62ee8eae3a84 1042 if(lr!=r||lt!=t){
TickTock 73:62ee8eae3a84 1043 tt.fillrect(264,64,310,239-t,Navy);
TickTock 73:62ee8eae3a84 1044 tt.fillrect(264,239-t,310,239-r,Red);
TickTock 73:62ee8eae3a84 1045 tt.fillrect(264,239-r,310,239,Green);
TickTock 73:62ee8eae3a84 1046 }
TickTock 73:62ee8eae3a84 1047 lt=t;
TickTock 73:62ee8eae3a84 1048 lr=r;
TickTock 66:b7476ce7a59e 1049 }
TickTock 37:fea2c1d52c5f 1050 }
TickTock 37:fea2c1d52c5f 1051
TickTock 36:dbd39c315258 1052 void updateDisplay(char display){
TickTock 36:dbd39c315258 1053 bool changed;
TickTock 36:dbd39c315258 1054 changed = dMode[display]!=lastDMode[display];
TickTock 36:dbd39c315258 1055 tt.set_display(display);
TickTock 36:dbd39c315258 1056 switch (dMode[display]) {
TickTock 36:dbd39c315258 1057 case logScreen:
TickTock 42:4533b13b297d 1058 printLog(changed,(display==whichTouched));
TickTock 36:dbd39c315258 1059 break;
TickTock 41:8d4609ea7259 1060 case mainScreen:
TickTock 42:4533b13b297d 1061 mainDisplay(changed,(display==whichTouched));
TickTock 36:dbd39c315258 1062 break;
TickTock 36:dbd39c315258 1063 case brakeScreen:
TickTock 42:4533b13b297d 1064 braking(changed,(display==whichTouched));
TickTock 36:dbd39c315258 1065 break;
TickTock 41:8d4609ea7259 1066 case dteScreen:
TickTock 50:83d5864c64a0 1067 dteDisplay(changed,(display==whichTouched),true);
TickTock 37:fea2c1d52c5f 1068 break;
TickTock 50:83d5864c64a0 1069 case effScreen:
TickTock 50:83d5864c64a0 1070 dteDisplay(changed,(display==whichTouched),false);
TickTock 50:83d5864c64a0 1071 break;
TickTock 50:83d5864c64a0 1072 case monitorScreen:
TickTock 42:4533b13b297d 1073 printLast(changed,(display==whichTouched));
TickTock 36:dbd39c315258 1074 break;
TickTock 36:dbd39c315258 1075 case changedScreen:
TickTock 42:4533b13b297d 1076 printChanged(changed,(display==whichTouched));
TickTock 36:dbd39c315258 1077 break;
TickTock 36:dbd39c315258 1078 case cpScreen:
TickTock 42:4533b13b297d 1079 cpData(changed||showCP,(display==whichTouched));
TickTock 36:dbd39c315258 1080 break;
leafman 98:9f8bab96edff 1081 case configScreen:
leafman 98:9f8bab96edff 1082 config(changed,(display==whichTouched));
TickTock 36:dbd39c315258 1083 break;
TickTock 38:155ec32c5e91 1084 case playbackScreen:
TickTock 42:4533b13b297d 1085 pbScreen(changed,(display==whichTouched));
TickTock 36:dbd39c315258 1086 break;
TickTock 36:dbd39c315258 1087 case dateScreen:
TickTock 42:4533b13b297d 1088 showDateTime(changed,(display==whichTouched));
TickTock 36:dbd39c315258 1089 break;
TickTock 44:6262a9fd1e56 1090 case cpHistScreen: // gg - hist
TickTock 47:9cc7d876dd6d 1091 cpHistogram(changed||showCP,(display==whichTouched));
TickTock 44:6262a9fd1e56 1092 break;
TickTock 48:d1ce92104a1f 1093 case cpBarScreen: // gg - cpbars
TickTock 48:d1ce92104a1f 1094 cpBarPlot(changed||showCP,(display==whichTouched));
TickTock 48:d1ce92104a1f 1095 break;
garygid 67:2022fce701d0 1096 case indexScreen:
garygid 67:2022fce701d0 1097 showIndex(changed,(display==whichTouched));
garygid 67:2022fce701d0 1098 break;
TickTock 107:e9be732c1ad4 1099 case tripScreen:
TickTock 107:e9be732c1ad4 1100 tripDisplay(changed,(display==whichTouched));
TickTock 107:e9be732c1ad4 1101 break;
TickTock 36:dbd39c315258 1102 default:
TickTock 43:e7f6f80590e3 1103 if (changed){
TickTock 43:e7f6f80590e3 1104 tt.background(Black);
TickTock 43:e7f6f80590e3 1105 tt.cls();
TickTock 43:e7f6f80590e3 1106 }
TickTock 36:dbd39c315258 1107 break;
TickTock 36:dbd39c315258 1108 }
TickTock 36:dbd39c315258 1109 lastDMode[display]=dMode[display];
TickTock 36:dbd39c315258 1110
TickTock 42:4533b13b297d 1111 if(display==whichTouched){
TickTock 42:4533b13b297d 1112 switch (sMode) {
TickTock 42:4533b13b297d 1113 case 1: // Select screens
TickTock 42:4533b13b297d 1114 tt.foreground(Yellow);
TickTock 42:4533b13b297d 1115 tt.background(DarkCyan);
garygid 54:6ce808d0995e 1116 tt.set_font((unsigned char*) Arial12x12);
garygid 54:6ce808d0995e 1117
garygid 54:6ce808d0995e 1118 showButton(0,tNavRow," <-Prev","",4,4); // gg - 4x4
garygid 67:2022fce701d0 1119 // col 1 see below
garygid 67:2022fce701d0 1120 showButton(2,tNavRow," Go To"," Index",4,4); // gg - index
garygid 54:6ce808d0995e 1121 showButton(3,tNavRow," Next->","",4,4); // gg - move next
garygid 54:6ce808d0995e 1122
garygid 67:2022fce701d0 1123 // col 1 in Nav row
TickTock 42:4533b13b297d 1124 switch (dMode[display]) {
TickTock 44:6262a9fd1e56 1125 case offScreen:
garygid 54:6ce808d0995e 1126 sprintf(sTemp2," Off");
TickTock 42:4533b13b297d 1127 break;
TickTock 44:6262a9fd1e56 1128 case logScreen:
garygid 54:6ce808d0995e 1129 sprintf(sTemp2," Log");
TickTock 42:4533b13b297d 1130 break;
TickTock 44:6262a9fd1e56 1131 case mainScreen:
garygid 54:6ce808d0995e 1132 sprintf(sTemp2," Main");
TickTock 42:4533b13b297d 1133 break;
TickTock 44:6262a9fd1e56 1134 case brakeScreen:
garygid 54:6ce808d0995e 1135 sprintf(sTemp2,"Braking");
TickTock 42:4533b13b297d 1136 break;
TickTock 44:6262a9fd1e56 1137 case dteScreen:
garygid 54:6ce808d0995e 1138 sprintf(sTemp2," DTE");
TickTock 42:4533b13b297d 1139 break;
TickTock 50:83d5864c64a0 1140 case effScreen:
garygid 54:6ce808d0995e 1141 sprintf(sTemp2," Eff");
TickTock 50:83d5864c64a0 1142 break;
TickTock 44:6262a9fd1e56 1143 case monitorScreen:
garygid 54:6ce808d0995e 1144 sprintf(sTemp2," Monitor");
TickTock 42:4533b13b297d 1145 break;
TickTock 44:6262a9fd1e56 1146 case changedScreen:
garygid 54:6ce808d0995e 1147 sprintf(sTemp2,"DeltaMon");
TickTock 42:4533b13b297d 1148 break;
TickTock 44:6262a9fd1e56 1149 case cpScreen:
garygid 67:2022fce701d0 1150 sprintf(sTemp2,"CP Data");
TickTock 42:4533b13b297d 1151 break;
leafman 98:9f8bab96edff 1152 case configScreen:
garygid 54:6ce808d0995e 1153 sprintf(sTemp2," Config");
leafman 98:9f8bab96edff 1154 break;
TickTock 44:6262a9fd1e56 1155 case playbackScreen:
garygid 54:6ce808d0995e 1156 sprintf(sTemp2,"Playback");
TickTock 42:4533b13b297d 1157 break;
TickTock 44:6262a9fd1e56 1158 case dateScreen:
garygid 54:6ce808d0995e 1159 sprintf(sTemp2,"Set Time");
TickTock 42:4533b13b297d 1160 break;
TickTock 44:6262a9fd1e56 1161 case cpHistScreen: // gg - hist
garygid 54:6ce808d0995e 1162 sprintf(sTemp2,"CP Hist");
TickTock 44:6262a9fd1e56 1163 break;
TickTock 48:d1ce92104a1f 1164 case cpBarScreen: // gg - cpbars
garygid 54:6ce808d0995e 1165 sprintf(sTemp2,"CP Bars");
TickTock 48:d1ce92104a1f 1166 break;
TickTock 107:e9be732c1ad4 1167 case tripScreen:
TickTock 107:e9be732c1ad4 1168 sprintf(sTemp2," Trip");
TickTock 107:e9be732c1ad4 1169 break;
garygid 67:2022fce701d0 1170 case indexScreen: // gg - index
garygid 67:2022fce701d0 1171 sprintf(sTemp2," Index");
garygid 67:2022fce701d0 1172 break;
TickTock 42:4533b13b297d 1173 }
garygid 54:6ce808d0995e 1174 showButton(1,tNavRow," Select",sTemp2,4,4);
garygid 54:6ce808d0995e 1175
TickTock 42:4533b13b297d 1176 wait_ms(100); // pause a moment to reduce flicker
TickTock 42:4533b13b297d 1177 break;
garygid 54:6ce808d0995e 1178
TickTock 42:4533b13b297d 1179 case 2: // numpad
TickTock 42:4533b13b297d 1180 tt.foreground(Yellow);
TickTock 42:4533b13b297d 1181 tt.background(DarkCyan);
TickTock 42:4533b13b297d 1182 tt.set_font((unsigned char*) Arial24x23);
garygid 54:6ce808d0995e 1183
garygid 54:6ce808d0995e 1184 sprintf(sTemp2,"");
garygid 54:6ce808d0995e 1185 showButton(0,0," 1",sTemp2,4,4);
garygid 54:6ce808d0995e 1186 showButton(1,0," 2",sTemp2,4,4);
garygid 54:6ce808d0995e 1187 showButton(2,0," 3",sTemp2,4,4);
garygid 54:6ce808d0995e 1188 showButton(0,1," 4",sTemp2,4,4);
garygid 54:6ce808d0995e 1189 showButton(1,1," 5",sTemp2,4,4);
garygid 54:6ce808d0995e 1190 showButton(2,1," 6",sTemp2,4,4);
garygid 54:6ce808d0995e 1191 showButton(0,2," 7",sTemp2,4,4);
garygid 54:6ce808d0995e 1192 showButton(1,2," 8",sTemp2,4,4);
garygid 54:6ce808d0995e 1193 showButton(2,2," 9",sTemp2,4,4);
garygid 54:6ce808d0995e 1194 showButton(1,3," 0",sTemp2,4,4);
garygid 54:6ce808d0995e 1195
garygid 54:6ce808d0995e 1196 showButton(0,3,"<--",sTemp2,4,4);
garygid 54:6ce808d0995e 1197 showButton(2,3,"-->",sTemp2,4,4);
garygid 54:6ce808d0995e 1198 showButton(3,3,"return",sTemp2,4,4);
TickTock 42:4533b13b297d 1199 case 3:
TickTock 42:4533b13b297d 1200 break;
TickTock 42:4533b13b297d 1201 default:
TickTock 42:4533b13b297d 1202 break;
TickTock 42:4533b13b297d 1203 }
TickTock 36:dbd39c315258 1204 }
TickTock 36:dbd39c315258 1205 }
TickTock 36:dbd39c315258 1206
garygid 58:4d06288d75a2 1207 //---------------------
garygid 58:4d06288d75a2 1208 // gg - highlight
TickTock 62:ffd15edb5431 1209 void highlightButton(unsigned char column, unsigned char row, unsigned char tScn, unsigned char columns, unsigned char rows){
TickTock 62:ffd15edb5431 1210
garygid 58:4d06288d75a2 1211 unsigned short x1,x2,y1,y2;
garygid 58:4d06288d75a2 1212
garygid 58:4d06288d75a2 1213 x1=column*(320/columns)+btnGap/2;
garygid 58:4d06288d75a2 1214 x2=(column+1)*(320/columns)-btnGap/2;
garygid 58:4d06288d75a2 1215 y1=row*(240/rows)+btnGap/2;
garygid 58:4d06288d75a2 1216 y2=(row+1)*(240/rows)-btnGap/2;
garygid 65:821fc79cd7fe 1217
garygid 65:821fc79cd7fe 1218 tt.set_display(tScn);
garygid 65:821fc79cd7fe 1219
garygid 65:821fc79cd7fe 1220 if( skin == ggSkin ){
garygid 65:821fc79cd7fe 1221 // paint the whole button box, for a better visual effect
garygid 65:821fc79cd7fe 1222 // especially on a screen with a yellow background
garygid 65:821fc79cd7fe 1223 if( tScn == 0 )
garygid 65:821fc79cd7fe 1224 tt.fillrect(x1,y1,x2,y2,White); // DarkCyan);
garygid 65:821fc79cd7fe 1225 else
garygid 65:821fc79cd7fe 1226 tt.fillrect(x1,y1,x2,y2,Green); // DarkCyan);
TickTock 66:b7476ce7a59e 1227 } else {
TickTock 66:b7476ce7a59e 1228 tt.fillrect(x1,y1,x2,y2,Green); // DarkCyan);
garygid 65:821fc79cd7fe 1229 }
garygid 58:4d06288d75a2 1230
garygid 58:4d06288d75a2 1231 // paint the outer pixel as a yellow frame
garygid 58:4d06288d75a2 1232 tt.rect(x1,y1,x2,y2,Yellow) ; // DarkCyan);
garygid 58:4d06288d75a2 1233 }
garygid 58:4d06288d75a2 1234
garygid 58:4d06288d75a2 1235 //---------------------
TickTock 36:dbd39c315258 1236 void showButton(unsigned char column, unsigned char row, char * text1, char * text2, unsigned char columns, unsigned char rows){
TickTock 36:dbd39c315258 1237 unsigned short x1,x2,y1,y2;
garygid 54:6ce808d0995e 1238
TickTock 36:dbd39c315258 1239 x1=column*(320/columns)+btnGap/2;
TickTock 36:dbd39c315258 1240 x2=(column+1)*(320/columns)-btnGap/2;
TickTock 36:dbd39c315258 1241 y1=row*(240/rows)+btnGap/2;
TickTock 36:dbd39c315258 1242 y2=(row+1)*(240/rows)-btnGap/2;
TickTock 36:dbd39c315258 1243 tt.fillrect(x1,y1,x2,y2,DarkCyan);
garygid 54:6ce808d0995e 1244
garygid 54:6ce808d0995e 1245 // adapt formatting of text to the smaller 4x4 box
garygid 54:6ce808d0995e 1246 tt.locate(x1+btnGap/2,y1+btnGap); // gg - 4x4
TickTock 36:dbd39c315258 1247 printf("%s\n",text1);
garygid 54:6ce808d0995e 1248
garygid 54:6ce808d0995e 1249 tt.locate(x1+btnGap/2,y1+btnGap+20);
TickTock 36:dbd39c315258 1250 printf("%s\n",text2);
TickTock 36:dbd39c315258 1251 }
garygid 54:6ce808d0995e 1252
leafman 98:9f8bab96edff 1253
leafman 98:9f8bab96edff 1254 //The temps are stored as metric, distances as imperial... I'm assuming the input based on that - LM
leafman 98:9f8bab96edff 1255 float convertTemperature(float input)
leafman 98:9f8bab96edff 1256 {
leafman 98:9f8bab96edff 1257 if (!metric) {
leafman 98:9f8bab96edff 1258 //convert!
leafman 98:9f8bab96edff 1259 float output = input *1.8f;
leafman 98:9f8bab96edff 1260 output += 32.0f;
leafman 98:9f8bab96edff 1261 return output;
leafman 98:9f8bab96edff 1262 }
leafman 98:9f8bab96edff 1263 return input;
leafman 98:9f8bab96edff 1264 }
leafman 98:9f8bab96edff 1265 float convertDistance(float input)
leafman 98:9f8bab96edff 1266 {
leafman 98:9f8bab96edff 1267 if (metric) {
leafman 98:9f8bab96edff 1268 return input / 0.62137f;
leafman 98:9f8bab96edff 1269 }
leafman 98:9f8bab96edff 1270 return input;
leafman 98:9f8bab96edff 1271 }
leafman 98:9f8bab96edff 1272 char* distanceUnit()
leafman 98:9f8bab96edff 1273 {
leafman 98:9f8bab96edff 1274 if(metric)
leafman 98:9f8bab96edff 1275 return "km";
leafman 98:9f8bab96edff 1276 return "mi";
leafman 98:9f8bab96edff 1277 }
leafman 98:9f8bab96edff 1278 char* temperatureUnit()
leafman 98:9f8bab96edff 1279 {
leafman 98:9f8bab96edff 1280 if(metric)
leafman 98:9f8bab96edff 1281 return "C";
leafman 98:9f8bab96edff 1282 return "F";
leafman 98:9f8bab96edff 1283 }
leafman 98:9f8bab96edff 1284
garygid 54:6ce808d0995e 1285 //-------------
TickTock 41:8d4609ea7259 1286 // below is braking screen normalized to power rather than force
TickTock 41:8d4609ea7259 1287 // changed to force since power had too large a dynamic range
TickTock 42:4533b13b297d 1288 /*void braking (bool force, bool showButtons, bool prdata=false){
TickTock 23:cd03f9c3395e 1289 unsigned long targetBraking, regenBraking, speed;
TickTock 73:62ee8eae3a84 1290 static unsigned long maxTarget = 20000, maxRegen = 20000, tardivreg_x1000 = 1000;
TickTock 13:62e0f7f39ff5 1291 short rpm;
TickTock 13:62e0f7f39ff5 1292 unsigned long temp;
TickTock 13:62e0f7f39ff5 1293 static unsigned char lastPressure[4] = {200,200,200,200};
TickTock 13:62e0f7f39ff5 1294 unsigned char i,r,t;
TickTock 13:62e0f7f39ff5 1295 static unsigned char lr, lt;
TickTock 13:62e0f7f39ff5 1296 CANMessage msg;
TickTock 13:62e0f7f39ff5 1297
TickTock 13:62e0f7f39ff5 1298 msg = lastMsg[indexLastMsg[0x1cb]]; //Get Target and Regen
TickTock 13:62e0f7f39ff5 1299 regenBraking = (msg.data[0]<<3)+(msg.data[1]>>5);
TickTock 13:62e0f7f39ff5 1300 targetBraking = (msg.data[2]<<3)+(msg.data[3]>>5);
TickTock 13:62e0f7f39ff5 1301 msg = lastMsg[indexLastMsg[0x176]]; //Get rpms - not sure what this is but scales to mph with .0725
TickTock 13:62e0f7f39ff5 1302 rpm = ((short)msg.data[0]<<8)+msg.data[1];
TickTock 13:62e0f7f39ff5 1303 speed =rpm>0?rpm>>3:-rpm>>3; //Take absolute to get speed; div8
TickTock 23:cd03f9c3395e 1304 if ((targetBraking>2039)||(speed>200)) { //Filter weird messages
TickTock 23:cd03f9c3395e 1305 targetBraking = 0;
TickTock 23:cd03f9c3395e 1306 regenBraking = 0;
TickTock 23:cd03f9c3395e 1307 } else {
TickTock 23:cd03f9c3395e 1308 if ((targetBraking>50)&&(regenBraking>50)){
TickTock 23:cd03f9c3395e 1309 temp = targetBraking;
TickTock 23:cd03f9c3395e 1310 temp *= 1000;
TickTock 23:cd03f9c3395e 1311 temp /= regenBraking;
TickTock 73:62ee8eae3a84 1312 if (temp<tardivreg_x1000) tardivreg_x1000=temp;
TickTock 23:cd03f9c3395e 1313 }
TickTock 23:cd03f9c3395e 1314 targetBraking *= speed;
TickTock 23:cd03f9c3395e 1315 regenBraking *= speed;
TickTock 23:cd03f9c3395e 1316 if (targetBraking>maxTarget) maxTarget=targetBraking;
TickTock 23:cd03f9c3395e 1317 if (regenBraking>maxRegen) maxRegen=regenBraking;
TickTock 23:cd03f9c3395e 1318 }
TickTock 23:cd03f9c3395e 1319
TickTock 13:62e0f7f39ff5 1320 msg = lastMsg[indexLastMsg[0x1ca]]; //Get brake pressure
TickTock 13:62e0f7f39ff5 1321 tt.background(Navy);
TickTock 13:62e0f7f39ff5 1322 if (force) {
TickTock 13:62e0f7f39ff5 1323 tt.cls();
TickTock 13:62e0f7f39ff5 1324 tt.rect(0,111,170,239,White);
TickTock 13:62e0f7f39ff5 1325 tt.line(0,207,170,207,White);
TickTock 13:62e0f7f39ff5 1326 tt.line(0,175,170,175,White);
TickTock 13:62e0f7f39ff5 1327 tt.line(0,143,170,143,White);
TickTock 13:62e0f7f39ff5 1328 lastPressure[0] = 200;
TickTock 13:62e0f7f39ff5 1329 lastPressure[1] = 200;
TickTock 13:62e0f7f39ff5 1330 lastPressure[2] = 200;
TickTock 13:62e0f7f39ff5 1331 lastPressure[3] = 200;
TickTock 13:62e0f7f39ff5 1332 }
TickTock 13:62e0f7f39ff5 1333 // plot bar graph for each wheel pressure
TickTock 92:935adef49ea4 1334 for (i=0; i<4; i++){
TickTock 13:62e0f7f39ff5 1335 if (msg.data[i]<239) {
TickTock 13:62e0f7f39ff5 1336 if (msg.data[i]>lastPressure[i]){
TickTock 13:62e0f7f39ff5 1337 tt.fillrect(10+40*i,239-msg.data[i],40+40*i,239,Red);
TickTock 13:62e0f7f39ff5 1338 } else if (msg.data[i]<lastPressure[i]) {
TickTock 13:62e0f7f39ff5 1339 tt.fillrect(10+40*i,238-lastPressure[i],40+40*i,238-msg.data[i],Navy);
TickTock 13:62e0f7f39ff5 1340 }
TickTock 13:62e0f7f39ff5 1341 lastPressure[i]=msg.data[i];
TickTock 13:62e0f7f39ff5 1342 }
TickTock 13:62e0f7f39ff5 1343 }
TickTock 13:62e0f7f39ff5 1344
TickTock 27:6bd073c33977 1345 temp = targetBraking;
TickTock 27:6bd073c33977 1346 temp *=200;
TickTock 27:6bd073c33977 1347 temp /= maxTarget;
TickTock 27:6bd073c33977 1348 t = (char) temp;
TickTock 27:6bd073c33977 1349 if (t>200) t=200;
TickTock 27:6bd073c33977 1350 temp = regenBraking;
TickTock 73:62ee8eae3a84 1351 temp *= tardivreg_x1000;
TickTock 27:6bd073c33977 1352 temp /= maxTarget;
TickTock 27:6bd073c33977 1353 temp /= 5;
TickTock 27:6bd073c33977 1354 r = (char) temp;
TickTock 27:6bd073c33977 1355 if (r>200) r=200;
TickTock 27:6bd073c33977 1356 if(lr!=r&&prdata){
TickTock 27:6bd073c33977 1357 tt.foreground(Yellow);
TickTock 27:6bd073c33977 1358 tt.set_font((unsigned char*) Arial28x28);
TickTock 27:6bd073c33977 1359 tt.locate(100,40);
TickTock 27:6bd073c33977 1360 printf("%d %d \n",regenBraking,maxRegen);
TickTock 27:6bd073c33977 1361 tt.locate(100,70);
TickTock 73:62ee8eae3a84 1362 printf("%3.1f (%3.1f%s) \n",(float)tardivreg_x1000/10,(float)regenBraking*tardivreg_x1000/targetBraking/10,"%");
TickTock 27:6bd073c33977 1363 }
TickTock 27:6bd073c33977 1364 if(lt!=t&&prdata){
TickTock 27:6bd073c33977 1365 tt.foreground(Yellow);
TickTock 27:6bd073c33977 1366 tt.set_font((unsigned char*) Arial28x28);
TickTock 27:6bd073c33977 1367 tt.locate(100,10);
TickTock 27:6bd073c33977 1368 printf("%d %d \n",targetBraking,maxTarget);
TickTock 13:62e0f7f39ff5 1369 }
TickTock 27:6bd073c33977 1370 if (r>t) t=r; //Should never happen
TickTock 27:6bd073c33977 1371 if((lr!=r||lt!=t)&&!prdata){
TickTock 27:6bd073c33977 1372 tt.fillrect(200,10,300,239-t,Navy);
TickTock 27:6bd073c33977 1373 tt.fillrect(200,239-t,300,239-r,Red);
TickTock 27:6bd073c33977 1374 tt.fillrect(200,239-r,300,239,Green);
TickTock 27:6bd073c33977 1375 }
TickTock 27:6bd073c33977 1376 lt=t;
TickTock 27:6bd073c33977 1377 lr=r;
TickTock 36:dbd39c315258 1378 }*/