Dual CANbus monitor and instrumentation cluster. Presently tuned for the Nissan Leaf EV.

Dependencies:   SPI_TFTx2_ILI9341 TFT_fonts TOUCH_TFTx2_ILI9341 mbed

Fork of CANary_corrupt by Tick Tock

After adding the LPC1768 platform, import as a program and do not select the "update to latest revision" box

User Guide

Eagle Schematic and Board design

/media/uploads/TickTock/canaryr6.zip

/media/uploads/TickTock/canary_sch.jpg

/media/uploads/TickTock/canaryr6brd.jpg

For LCD Rev 1.01:

/media/uploads/TickTock/lcdsch.jpg

For VCD Rev 2.00:

/media/uploads/TickTock/lcdr2.jpg

Parts List

qtyinstancepart #packagesupplierDescription
1BAT3Vhttp://www.ebay.com/itm/10x-CR2032-SMD-Battery-Holder-for-CR2032-Battery-/180938057979?pt=LH_DefaultDomain_0&hash=item2a20bfa8fbLithium 2032 coin battery holder
4C1-C4ECST1DC106R6032Tantalium capacitor 10uF
3FC1-FC3ZF1-20-01-T-WThttp://www.samtec.com/cable-systems/idc-ffc/ffc/zero-insertion.aspx20 conductor 1mm pitch flex cable connector (optional)
1FJ-20-R-08.00-4http://www.samtec.com/cable-systems/idc-ffc/ffc/zero-insertion.aspx8\" 20 conductor 1mm pitch flex connector, end reversed (optional)
2H1-H4(DON'T populate H1-H4 headers - solder mbed directly)
1H5http://www.ebay.com/itm/221186042943?ssPageName=STRK:MEWNX:IT&_trksid=p3984.m1497.l26491x12 .1\" pitch header (optional)
1H62x6 .1\" pitch header (optional)
2IC1,IC2VP230LMDSOP8http://www.ebay.com/itm/130488665247?ssPageName=STRK:MEWNX:IT&_trksid=p3984.m1497.l2649canbus transciever
1IC3LM1117-5VSOT2235V regulator
5JP*2 pin .1\" jumper header
1mbedLPC1768http://www.ebay.com/itm/200830573509?ssPageName=STRK:MEWNX:IT&_trksid=p3984.m1497.l2649mbed uC
2Q1,Q22N2222SOT23General purpose NPN transistor
1R1R393M120639K resistor
1R2R103M120610K resistor
4R4-R6R102M12061K resistor
1R3R500M120650 Ohm resistor
2TR1-TR5ZJYS81R5-2PL51TG01http://www.digikey.com/product-detail/en/ZJYS81R5-2PL51T-G01/445-2223-1-ND/765232CM Choke
1Z11N5340BGC1702-15http://www.ebay.com/itm/150878122425?ssPageName=STRK:MEWNX:IT&_trksid=p3984.m1497.l26496V, 5W Zener Diode
1Z1DC-DC conveterhttp://www.ebay.com/itm/251142727849?ssPageName=STRK:MEWNX:IT&_trksid=p3984.m1497.l264912V-7V, 3W DC-DC converter
1X1USBhttp://www.ebay.com/itm/New-Vertical-USB-2-0-A-pcb-connector-socket-USB-A-Type-/300553895292?pt=LH_DefaultDomain_0&hash=item45fa687d7cvertical USB connector
2LCD0,LCD1TFThttp://www.mikroe.com/add-on-boards/display/tft-proto/320x240 LCD with touch screen
1E0Enclosurehttp://www.shapeways.com/model/1077799/canary.html?li=user-profile&materialId=63d printed enclosure

Assembly

1) LCD Displays

I found ribbon cable is a nice way to organize the wires to the displays. There are two versions of the display and each must be wired differently. The original project used HW REV. 1.01. For that version, you'll need 12 conductors and I connected them in the following order:

1LED+
2LED-
3RST
4SDI
5WR/SCLK
6CS
7X+
8X-
9Y+
10Y-
11VDD
12GND

If, instead, you have HW REV 2.0, you will need 13 conductors with the following order:

1LED+
2LED-
3RST
4SDI
5RS (SCLK)
6WR (DC)
7CS
8X+
9X-
10Y+
11Y-
12VDD
13GND

First I connected all the GND connections (2 GND & IM0, IM1, IM3 for REV1.01 or 2 GND, RD, & IM0 for REV2.00). Do not connect the bottom GND until you have the ribbon cable connected. After making all the ribbon cable connections (connecting the GND of the ribbon cable to the bottom GND pad), solder the GND bar from the previous step to the back of the bottom GND connection. Finally, make a connection from the back side 3.3V pin to IM2 for REV1.01 or to IM1,IM2,&IM3 for REV2.00. Take a break and repeat for the second display.

Examples of REV1.01 boards:

/media/uploads/TickTock/lcdtop.jpg /media/uploads/TickTock/lcdbot.jpg

Examples of REV2.00:

/media/uploads/TickTock/rev2front.jpg /media/uploads/TickTock/rev2back.jpg

Once the two displays are complete combine all wires except CS0, CS1, X+, X-, Y+, and Y-. Connect X- of the left display to X+ of the right. Similarly connect Y- of the left display to Y+ of the right. Insulate any exposed wires.

2) PCB

Refer to the schematics to place all the components on the board. If you plan to install into the CANary 3D enclosure, DO NOT install the battery holder or the socket for the mbed and, instead, connect two wires to the VB and GND pads nearby. You will have to install the battery holder against the back wall to avoid interfering with the right-hand display and the mbed will have to be directly soldered. I have not found a socket with a low enough profile to fit in the space provided (depth of enclosure is limited by the space behind the center console). Also, I recommend keeping as much lead as possible on the Zener diode (bending it as shown to clear the back wall). Although it is operating well within parameters, the Zener gets quite hot during extended operation and the leads help dissipate the heat and keep it away from the PCB and other components.Update: Several Zeners have failed resulting in damage to some users boards so I recommend using a DC-DC converter instead to bring the 12V down to 7V.

/media/uploads/TickTock/pcbtop.jpg /media/uploads/TickTock/pcbbot.jpg

Once the PCB is populated, solder the LCDs to the PCB. CS0 connects to the right display and CS1 connects to the left. /media/uploads/TickTock/brddis.jpg

Update: The Zener diodes tended to fail after a few months so I am recommending removing them and replacing with a DC-DC converter. This will run cooler and waste less energy, too. To install, remove the left display panel to gain access to the Zener. From there, the Zener can be removed and it's pads used to connect to the DC-DC converter. I recommend setting the output voltage on the bench before installing since the trim pot is tricky to reach once installed. Set it to 7V. The input can be connected to the left pad previously occupied by the zener and the output can connect to the right. GND(-) can be connected to the bottom right pad on the 2x6 header below the flex cable connector. Make sure the GND wire lies flat so it doesn't interfere with the connection of the flex cable. /media/uploads/TickTock/dcdcinst2.jpg

Once soldered in place, the DC-DC converter can easily be mounted to the back wall with double sided tape above the battery holder. /media/uploads/TickTock/dcdcinst3.jpg

3) Testing

1)First step is to buzz out all connections from the LCDs to the pins in the main board
2)Next check the touch screen connections. On the main board, place an Ohm meter across X+ and X-. You should read 700 Ohms. Repeat for Y+ and Y-. Then test the resistance from X+ to Y+. With nothing touching the screens, it should read >100K Ohms and <1K when touching either screen.
3)When all connections are checked, solder in the mbed. Download and install the touch2 program http://mbed.org/users/TickTock/code/touch2/ to test the basic operation of the mbed and touch screens.
tips:
Touch screen is sensitive - excess flux on X+,X-,Y+,Y- connection on mbed can result in flakey operation
If touch is not working, double-check the LCD0_CS and LCD1_CS are not swapped. LCD0_CS must connect to the CS of the LCD that has X- & Y- connected to the mbed. LCD1_CS must connect to the CS of the LCD that has X+ & Y+ connected to the mbed.
4)Once touch2 works, it is time to connect to the OBD connector. I highly recommend double checking all connections from the OBD to the PCB with the cable in place before connecting to the Leaf. Buzz out all the pins in the OBS to make sure none are shorting to each other, Check that the 12V goes to the Zener (and nothing else) and the switched 12V to the resistor divider (and nothing else). Test the ground connection properly connects to ground and nothing else.
5)Once you are confident there are no shorts or wrong connections from the OBD connector, take a deep breath and plug it into your leaf. Touch2 program should come up and function. Unplug and install the latest CANary firmware. If you have the REV2.00 LCD boards, you will need to edit the precompile.h file in the TOUCH_TFTx2_w9341 library and set USE_ILI9341 to 1. Test all features before installing into the enclosure (gids, cellpair, menu system, logging) since installing and removing from the enclosure is a PITA.

/media/uploads/TickTock/pcbdone.jpg /media/uploads/TickTock/functioning.jpg

4) Enclosure

The 3D printer leaves a lot of powder behind - I used a strong spray of water to get it out of all the cracks. The enclosure comes with a rather rough finish. I recommend convincing yourself you like it, then simply lightly sand then paint before assembly. Sanding is very difficult - the nylon is very nicely fused and doesn't want to sand. I tried sandblasting and that didn't work either. I had some limited success with filler and then sanding, but only on the outside - it is too difficult to sand the face. /media/uploads/TickTock/enclosure.jpg

5) Final Assembly

Make sure you are well rested with lots of patience before attempting assembly. It is a puzzle figuring out how to get both displays and the PCB in place. Enclosure was too expensive for me to keep iterating to optimize for assembly. I ended up snipping the thin display posts shorter and using various tools to push the displays into place. Also, some USB connectors are taller than others. If you have one of the taller ones, you will have to deflect the back wall a bit while inserting the PCB (being careful not to bend the housing) to get it to it's opening in the back wall. Do use a screw in the provided post to secure the PCB as USB insertion will otherwise dislodge it.

I added an additional safety line which wraps around the center post to prevent the enclosure from becoming a projectile in the event of an accident. /media/uploads/TickTock/safety.jpg Installed: /media/uploads/TickTock/installed.jpg

Committer:
TickTock
Date:
Sat Apr 13 22:46:31 2013 +0000
Revision:
68:10f7d7dbae19
Parent:
67:2022fce701d0
Parent:
66:b7476ce7a59e
Child:
72:f9a6faa28873
merged

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