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:
Tue Apr 09 04:13:20 2013 +0000
Revision:
52:d5385fbf4ea1
Parent:
50:83d5864c64a0
Child:
55:591406a71fa8
Improved DTE to eliminate discontinuity at 1 minute and reduce occasional flicker

Who changed what in which revision?

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