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:
Sun May 18 04:48:20 2014 +0000
Revision:
187:af5ba64c0afe
Parent:
184:5ca7b78297fe
Added LED dim/bright control

Who changed what in which revision?

UserRevisionLine numberNew contents of line
TickTock 13:62e0f7f39ff5 1 // main.cpp
TickTock 108:29b5a760adc2 2 //
TickTock 4:8d7759f4fe7a 3 //To Do:
TickTock 166:ec3951ba9701 4 // * Fix USB hot plug (must reset every time USB plugged)
TickTock 33:a277743ebdeb 5 // * Add 50% charge option
TickTock 152:a4d66901785d 6 // * Add linear efficiency graph with 10 minute values
TickTock 146:88f7bda79d8e 7 // * Add in-device config editor
TickTock 149:e9739523109f 8 // * Change pack volt color when CVLI fails
TickTock 149:e9739523109f 9 // * Add tire pressure cal (40psi for me = FR 38, RR 38.2, FL 37.8, RL 38 - maybe 2psi error on my tire gauge?)
TickTock 164:46ed06263b0e 10 // * Add on screen messages for heater on, etc, and use refresh feature above to clear in x seconds
TickTock 169:84d790ac18a2 11 // * Be more efficient with write buffer (use msgLen instead of always storing 8 bytes)
TickTock 187:af5ba64c0afe 12 // * Merge with 9341
TickTock 184:5ca7b78297fe 13 // rev184
TickTock 184:5ca7b78297fe 14 // Fixed wh adjustment algorithm
TickTock 134:ad243e4f1a17 15
TickTock 12:8e42d7ba8468 16 #include "mbed.h"
TickTock 12:8e42d7ba8468 17 #include "CAN.h"
TickTock 109:3e6f0e8fca0d 18 #include "ff.h"
TickTock 12:8e42d7ba8468 19 #include "PowerControl.h"
TickTock 12:8e42d7ba8468 20 #include "EthernetPowerControl.h"
TickTock 12:8e42d7ba8468 21 #include "utility.h"
TickTock 12:8e42d7ba8468 22 #include "displayModes.h"
TickTock 23:cd03f9c3395e 23 #include "TOUCH_TFTx2.h"
TickTock 172:53548bf8bf85 24
TickTock 184:5ca7b78297fe 25 char revStr[7] = "184";
TickTock 170:7ee98e3611bc 26 unsigned long maxTarget = 1000;
TickTock 109:3e6f0e8fca0d 27 FATFS USBdrive;
TickTock 13:62e0f7f39ff5 28 LocalFileSystem local("local");
TickTock 115:549410af477d 29 unsigned char wait5secs = 5;
TickTock 13:62e0f7f39ff5 30 // to write to USB Flash Drives, or equivalent (SD card in Reader/Writer)
TickTock 119:0e2b641e98a2 31 // class10 SDcard in Reader/Writer recommended
TickTock 111:d1559bb25c43 32 FRESULT mfr = f_mount(0,&USBdrive);
TickTock 13:62e0f7f39ff5 33 time_t seconds ;
TickTock 13:62e0f7f39ff5 34
TickTock 36:dbd39c315258 35 Ticker autoPoll;
TickTock 36:dbd39c315258 36 Ticker playback;
TickTock 78:a383971fe02f 37 Ticker msgReq;
TickTock 140:ab3e94eb0227 38 Ticker geiger;
TickTock 13:62e0f7f39ff5 39 Timer timer;
TickTock 13:62e0f7f39ff5 40
TickTock 13:62e0f7f39ff5 41 DigitalOut led1(LED1);
TickTock 13:62e0f7f39ff5 42 DigitalOut led2(LED2);
TickTock 13:62e0f7f39ff5 43 DigitalOut led3(LED3);
TickTock 13:62e0f7f39ff5 44 DigitalOut led4(LED4);
TickTock 13:62e0f7f39ff5 45
TickTock 13:62e0f7f39ff5 46 InterruptIn touchpad(p17);
TickTock 13:62e0f7f39ff5 47 CAN can1(p9, p10); // CAN1 (EV) uses pins 9 and 10 (rx, tx) and pin 8 (rs)
TickTock 13:62e0f7f39ff5 48 DigitalOut can1SleepMode(p8); // Use pin 8 to control the sleep mode of can2
TickTock 13:62e0f7f39ff5 49 CAN can2(p30, p29); // CAN2 (CAR) uses pins 30 and 29 (rx, tx) and pin 28 (rs)
TickTock 13:62e0f7f39ff5 50 DigitalOut can2SleepMode(p28); // Use pin 28 to control the sleep mode of can1
TickTock 35:5acbd8a64a89 51 AnalogIn mon12V(p15);
TickTock 13:62e0f7f39ff5 52 TOUCH_TFTx2 tt(p16, p17, p19, p20, p11, p12, p13, p6, p7, p5, "TFT"); // x+,x-,y+,y-,mosi, miso, sclk, cs0, cs1, reset
TickTock 35:5acbd8a64a89 53 PwmOut dled(p23);
TickTock 155:f31006516956 54 PwmOut spkr(p21);
TickTock 13:62e0f7f39ff5 55
garygid 87:46ac3f2519d6 56 bool debugMode = false;
TickTock 108:29b5a760adc2 57 bool usbEn = false;
TickTock 131:0d926c080a65 58 bool logEn = false;
TickTock 108:29b5a760adc2 59 bool logOpen = false;
TickTock 115:549410af477d 60 bool yesBattLog = true; // gg - Batt Log
TickTock 108:29b5a760adc2 61 unsigned char tNavRow = 3; // gg - 4x4 touch
TickTock 140:ab3e94eb0227 62 bool brakeMon = false; // disable until desired value read from config
TickTock 155:f31006516956 63 bool regenMon = false;
TickTock 159:577e9d015693 64 bool heaterMon = false;
TickTock 152:a4d66901785d 65 bool autoSync = false; // auto clock sync on powerup
TickTock 152:a4d66901785d 66 bool syncDone = true;
TickTock 159:577e9d015693 67 bool heaterOn = false;
TickTock 159:577e9d015693 68 bool lHeaterOn = false;
TickTock 164:46ed06263b0e 69 bool CCon = false;
TickTock 164:46ed06263b0e 70 bool lCCon = false;
garygid 54:6ce808d0995e 71
TickTock 109:3e6f0e8fca0d 72 FILE *hfile; // history file
TickTock 109:3e6f0e8fca0d 73 FIL efile; // external usb file
TickTock 109:3e6f0e8fca0d 74 FRESULT efr; // external file access flags
TickTock 109:3e6f0e8fca0d 75 unsigned int bytesRW;
TickTock 108:29b5a760adc2 76 char fileName[35] = "";
TickTock 84:fd21e5d32dab 77 char writeBuffer[maxBufLen][13] __attribute__ ((section("AHBSRAM1"))); // buffer for USB write
TickTock 13:62e0f7f39ff5 78 char indexLastMsg[0x800]={0}; // index table for last message
TickTock 13:62e0f7f39ff5 79 CANMessage lastMsg[100]; // table to store last message of eachtype
garygid 87:46ac3f2519d6 80
TickTock 124:0d622967b764 81 unsigned char battData[BatDataBufMax]={0}; // 7 * 0x3D = BatDataBufMax
garygid 87:46ac3f2519d6 82
TickTock 13:62e0f7f39ff5 83 unsigned char msgChanged[100]; // inidcates which bytes changed
TickTock 13:62e0f7f39ff5 84 char c;
TickTock 76:fb6779d0963e 85 volatile int writePointer = 0;
TickTock 76:fb6779d0963e 86 int readPointer=0;
TickTock 141:cf13a632ddb5 87 volatile unsigned short secsNoCarCanMsg = canTimeout;
TickTock 141:cf13a632ddb5 88 volatile unsigned short secsNoEvCanMsg = canTimeout;
TickTock 75:77bd26829dca 89 volatile unsigned short secsNoTouch = 0;
TickTock 132:08748a67280a 90 volatile bool carCanIdle,evCanIdle,userIdle;
TickTock 26:462ccb580472 91 bool touched=false; //flag to read touchscreen
TickTock 42:4533b13b297d 92 unsigned char whichTouched = 0;
TickTock 13:62e0f7f39ff5 93 char counter = 0;
TickTock 41:8d4609ea7259 94 unsigned char dMode[2] = {mainScreen,brakeScreen}; //display mode
TickTock 13:62e0f7f39ff5 95 unsigned char sMode = 0; // setup mode
TickTock 13:62e0f7f39ff5 96 unsigned char lastDMode[2] = {0,0}; //last screen mode
TickTock 131:0d926c080a65 97 unsigned char dtMode = 0;
TickTock 13:62e0f7f39ff5 98 char displayLog[20][40];
TickTock 13:62e0f7f39ff5 99 unsigned char displayLoc = 0;
leafman 98:9f8bab96edff 100 unsigned int fwCount=1;
TickTock 13:62e0f7f39ff5 101 unsigned char indexOffset = 1;
TickTock 13:62e0f7f39ff5 102 bool showCP = false;
TickTock 39:eef8beac7411 103 bool logCP = false; //Turbo3
TickTock 108:29b5a760adc2 104 bool logOnce = false;
TickTock 103:1389e9efe8c3 105 bool repeatPoll = true;
TickTock 34:4751a8259b18 106 bool headlights = false;
TickTock 140:ab3e94eb0227 107 bool miles_kmbar = true;
TickTock 34:4751a8259b18 108 bool tick = false;
garygid 69:6bfdfc002036 109 bool ZeroSecTick = false;
TickTock 35:5acbd8a64a89 110 float ledHi = 0.8; // Bright LED value (until config file read)
TickTock 35:5acbd8a64a89 111 float ledLo = 0.1; // Dim LED value (until config file read)
TickTock 35:5acbd8a64a89 112 unsigned short pollInt = 300; // polling interval=5 minutes (until config file read)
TickTock 35:5acbd8a64a89 113 bool accOn = false; // Accessories on
TickTock 49:a3d2c5bb3cfa 114 bool laccOn = false;
TickTock 35:5acbd8a64a89 115 float scale12V = 16.2; // R1:R2 ratio
TickTock 170:7ee98e3611bc 116 float kWperGid = 0.080;
TickTock 170:7ee98e3611bc 117 unsigned short startGids = 0; // Gids at start of trip
TickTock 177:6fda79c2fda1 118 unsigned short dailyGids = 0; // Gids per day
TickTock 172:53548bf8bf85 119 bool getGids = false;
TickTock 40:0e6e71a7323f 120 signed long mWs_x4 = 0;
TickTock 40:0e6e71a7323f 121 unsigned short numWsamples = 0;
TickTock 41:8d4609ea7259 122 unsigned short numSsamples = 0;
TickTock 35:5acbd8a64a89 123 float accV = 0;
TickTock 143:88b5155622a5 124 float accV2 = 0;
TickTock 161:71ac85d11f03 125 float CCkW = 0;
TickTock 36:dbd39c315258 126 bool playbackEn = false;
TickTock 36:dbd39c315258 127 bool playbackOpen = false;
TickTock 49:a3d2c5bb3cfa 128 //float playbackInt = 0.05; //read messages every 50 ms
TickTock 78:a383971fe02f 129 float playbackInt = 0.005; //read messages every 5 ms
TickTock 36:dbd39c315258 130 bool step = false;
TickTock 37:fea2c1d52c5f 131 char header[5];
TickTock 36:dbd39c315258 132 char data[8];
TickTock 174:cd27e80f197d 133 signed long motorRPM;
garygid 65:821fc79cd7fe 134 unsigned char skin = ttSkin ;
TickTock 50:83d5864c64a0 135 unsigned char dtePeriod = 14; //ten minute averaging interval
TickTock 176:9c19f9856c76 136 float CCkWh_trip[4]={0};
TickTock 176:9c19f9856c76 137 float kWh_trip[4]={0};
TickTock 176:9c19f9856c76 138 float miles_trip[4]={0};
TickTock 144:b0c9d30dd346 139 float curEff = 0;
TickTock 158:059abeb44ba1 140 float maxTripEff = 0;
TickTock 158:059abeb44ba1 141 float minTripEff = 5;
TickTock 167:58d4edf403d4 142 float maxTripMiles = 0;
TickTock 167:58d4edf403d4 143 float maxTripkWh = 1;
TickTock 167:58d4edf403d4 144 float maxTripCCkWh = 0;
TickTock 167:58d4edf403d4 145 float minTripMiles = 5;
TickTock 167:58d4edf403d4 146 float minTripkWh = 1;
TickTock 167:58d4edf403d4 147 float minTripCCkWh = 0;
TickTock 49:a3d2c5bb3cfa 148 float mph[39]={0};
TickTock 49:a3d2c5bb3cfa 149 float kW[39]={0};
TickTock 49:a3d2c5bb3cfa 150 float mpkWh[39]={0};
TickTock 162:c6545fc0164a 151 float mpkWh_noCC=0;
TickTock 120:041edeec08f5 152 float unloadedV_x2,Resr,curRmax,curRmin,redRmax,redRmin,incRmax,incRmin;
TickTock 121:553faf139a20 153 signed short Imax, Imin;
TickTock 49:a3d2c5bb3cfa 154 // Logarithmic division scale (roughly - snapped to common units of time)
TickTock 49:a3d2c5bb3cfa 155 float timeConstant[39] = {1, 1.58, 2.51, 3.98, 6.31, 10, 15.8, 25.1, 39.8, 60, // 1 minute
TickTock 52:d5385fbf4ea1 156 60*1.58, 60*2.51, 60*3.98, 60*6.31, 60*10, 60*15.8, 60*25.1, 60*39.8, 60*60, // 1 hour
TickTock 52:d5385fbf4ea1 157 60*60*1.58, 60*60*2.51, 60*60*3.98, 60*60*6.31, 60*60*10, 60*60*15.8, 60*60*24, // 1 day
TickTock 52:d5385fbf4ea1 158 60*60*24*1.58, 60*60*24*2.51, 60*60*24*3.98, 60*60*24*6.31, 60*60*24*10, 60*60*24*15.8, 60*60*24*30, // 1 month
TickTock 52:d5385fbf4ea1 159 60*60*24*39.8, 60*60*24*63.1, 60*60*24*100, 60*60*24*158, 60*60*24*251, 60*60*24*365}; // 1 year
TickTock 121:553faf139a20 160 bool tock = false;
TickTock 73:62ee8eae3a84 161 unsigned short pointerSep;
TickTock 78:a383971fe02f 162 unsigned char reqMsgCnt = 99;
TickTock 102:fd19f777a0b4 163 unsigned long Ah_x10000 = 0;
TickTock 102:fd19f777a0b4 164 unsigned long SOC_x10000 = 0;
TickTock 143:88b5155622a5 165 unsigned short SOH2_x100 = 0;
TickTock 108:29b5a760adc2 166 float maxTemp = 0;
leafman 98:9f8bab96edff 167 bool metric = false;
TickTock 121:553faf139a20 168 bool shunt[96]={0};
TickTock 121:553faf139a20 169 bool charging=false;
TickTock 131:0d926c080a65 170 bool showHealth=false;
TickTock 175:0357b4159b40 171 unsigned char saveDmode[2] = {99, 99};
TickTock 131:0d926c080a65 172 bool moving=false;
TickTock 140:ab3e94eb0227 173 unsigned short chirpInt;
TickTock 150:ef46ce63345c 174 unsigned short uMsgId[8] = {0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000}; // messages to display on debug screen msgId:byte
TickTock 152:a4d66901785d 175 unsigned short modelYear = 2011;
TickTock 153:e94cfe3c339c 176 bool idir, lidir;
TickTock 154:90ea16ca7475 177 bool enableSound=false;
TickTock 158:059abeb44ba1 178 bool clearTest=true;
TickTock 171:355e284f5201 179 unsigned long tbScalar = 72464;
TickTock 171:355e284f5201 180 unsigned long rbScalar = 8696;
TickTock 171:355e284f5201 181 unsigned long fbScalar = 132;
TickTock 177:6fda79c2fda1 182 int effCheckTime = 3;
TickTock 177:6fda79c2fda1 183 bool ignoreDayData = true;
TickTock 179:e4094e55f079 184 unsigned short cgids,lgids=0;
TickTock 179:e4094e55f079 185 unsigned short whpg[300]={0};
TickTock 180:5fdeeb86f3a3 186 float wh[300];
TickTock 180:5fdeeb86f3a3 187 float maxWhpg,minWh,whOff;
TickTock 13:62e0f7f39ff5 188
TickTock 0:1596b8644523 189 int main() {
TickTock 4:8d7759f4fe7a 190 char sTemp[40];
TickTock 2:71b1999a8ea5 191 unsigned long secs;
TickTock 179:e4094e55f079 192 unsigned short i,j;
TickTock 179:e4094e55f079 193 unsigned char display=0,lwt=0;
TickTock 22:a43df3905863 194 point lastTouch;
TickTock 52:d5385fbf4ea1 195 float average;
TickTock 3:3e879b043bc5 196 tt.set_orientation(1);
TickTock 4:8d7759f4fe7a 197 tt.background(Black);
TickTock 19:d576298c46f3 198 tt.set_display(2); // select both displays
TickTock 3:3e879b043bc5 199 tt.cls();
TickTock 137:70853cf5a30f 200 tt.foreground(White);
TickTock 137:70853cf5a30f 201 tt.set_font((unsigned char*) Arial12x12_prop); // select the font
TickTock 137:70853cf5a30f 202 tt.locate(0,0);
TickTock 1:9dcd70c32180 203 tt.claim(stdout); // send stdout to the TFT display
TickTock 137:70853cf5a30f 204 if(tt.is_touched()){ // If touching screen on poweron then update firmware
TickTock 137:70853cf5a30f 205 updateFirmware();
TickTock 137:70853cf5a30f 206 }
TickTock 12:8e42d7ba8468 207 touchpad.rise(&touch_ISR);
TickTock 4:8d7759f4fe7a 208 tt.wfi(); // enable interrupt on touch
TickTock 155:f31006516956 209 dled.period(0.001);
TickTock 154:90ea16ca7475 210 dled = ledHi; // turn on display LED 80%
TickTock 155:f31006516956 211 spkr = 0;
TickTock 120:041edeec08f5 212 Resr = 0.075; // initial guess of Resr
TickTock 2:71b1999a8ea5 213 timer.start() ;
TickTock 2:71b1999a8ea5 214 RTC_Init(); // start the RTC Interrupts that sync the timer
TickTock 176:9c19f9856c76 215 struct tm t,lt; // pointer to a static tm structure
TickTock 93:c2402e8cd0e2 216 NVIC_SetPriority(CAN_IRQn, 2); //set can priority just below RTC
TickTock 117:49883c779a74 217 NVIC_SetPriority(TIMER3_IRQn, 3); //set ticker priority just below can
TickTock 33:a277743ebdeb 218
TickTock 1:9dcd70c32180 219 seconds = time(NULL);
TickTock 177:6fda79c2fda1 220 t = *localtime(&seconds);
TickTock 177:6fda79c2fda1 221 lt = t; // initialize
TickTock 1:9dcd70c32180 222 // is it a date before 2012 ?
TickTock 26:462ccb580472 223 if ((t.tm_year + 1900) < 2012 ) {
TickTock 26:462ccb580472 224 // before 2013 so update year to make date entry easier
TickTock 26:462ccb580472 225 t.tm_year = 2013 - 1900;
TickTock 1:9dcd70c32180 226 // set the RTC
TickTock 1:9dcd70c32180 227 set_time(mktime(&t));
TickTock 1:9dcd70c32180 228 seconds = time(NULL);
TickTock 26:462ccb580472 229 }
TickTock 20:3bf176d14b14 230 t = *localtime(&seconds) ;
TickTock 20:3bf176d14b14 231 strftime(sTemp, 32, "%a %m/%d/%Y %X\n", &t);
TickTock 93:c2402e8cd0e2 232 printMsg(sTemp); // record RTC
garygid 54:6ce808d0995e 233
TickTock 62:ffd15edb5431 234 // revision
garygid 70:0700b769ac15 235 sprintf(sTemp,"CANary firmware rev%s\n", revStr); // gg - for Logging the revision
TickTock 93:c2402e8cd0e2 236 printMsg(sTemp); // revision
TickTock 17:e32324a2678d 237
TickTock 179:e4094e55f079 238 for(i=0;i<300;i++){ // initialize wh lookup
TickTock 181:396fdcceefd2 239 wh[i]=i*kWperGid*1000;
TickTock 179:e4094e55f079 240 }
TickTock 179:e4094e55f079 241
TickTock 49:a3d2c5bb3cfa 242 //read efficiency history data
TickTock 150:ef46ce63345c 243 hfile = fopen("/local/ehist.cny", "r");
TickTock 97:a25940fd7b5b 244 if (hfile!=NULL){ // found a efficiency history file
TickTock 49:a3d2c5bb3cfa 245 for(i=0;i<39;i++){
TickTock 97:a25940fd7b5b 246 if(!feof(hfile)){
TickTock 97:a25940fd7b5b 247 fscanf(hfile,"%f %f\r\n",&mph[i],&kW[i]);
TickTock 49:a3d2c5bb3cfa 248 mpkWh[i]=mph[i]/kW[i];
TickTock 166:ec3951ba9701 249 if(i==dtePeriod) mpkWh_noCC=mpkWh[i];
TickTock 49:a3d2c5bb3cfa 250 }
TickTock 49:a3d2c5bb3cfa 251 }
TickTock 134:ad243e4f1a17 252 if(!feof(hfile)){
TickTock 134:ad243e4f1a17 253 fscanf(hfile,"%f %f\r\n",&maxTripEff,&minTripEff);
TickTock 134:ad243e4f1a17 254 }
TickTock 155:f31006516956 255 if(!feof(hfile)){
TickTock 155:f31006516956 256 fscanf(hfile,"%f\r\n",&Resr);
TickTock 155:f31006516956 257 }
TickTock 167:58d4edf403d4 258 if(!feof(hfile)){
TickTock 167:58d4edf403d4 259 fscanf(hfile,"%f %f\r\n",&maxTripMiles,&minTripMiles);
TickTock 167:58d4edf403d4 260 }
TickTock 167:58d4edf403d4 261 if(!feof(hfile)){
TickTock 167:58d4edf403d4 262 fscanf(hfile,"%f %f\r\n",&maxTripkWh,&minTripkWh);
TickTock 167:58d4edf403d4 263 }
TickTock 167:58d4edf403d4 264 if(!feof(hfile)){
TickTock 167:58d4edf403d4 265 fscanf(hfile,"%f %f\r\n",&maxTripCCkWh,&minTripCCkWh);
TickTock 167:58d4edf403d4 266 }
TickTock 180:5fdeeb86f3a3 267 for(i=0;i<300;i++){
TickTock 180:5fdeeb86f3a3 268 if(feof(hfile)) break;
TickTock 180:5fdeeb86f3a3 269 fscanf(hfile,"%f\r\n",&wh[i]);
TickTock 179:e4094e55f079 270 }
TickTock 97:a25940fd7b5b 271 fclose(hfile);
TickTock 116:5cd72bae7c12 272 printMsg("History Loaded.\n"); // History loaded
TickTock 49:a3d2c5bb3cfa 273 } else { // create initial file
TickTock 116:5cd72bae7c12 274 printMsg("History not found. Created.\n"); // history not found, created
TickTock 49:a3d2c5bb3cfa 275 for(i=0;i<39;i++){
TickTock 49:a3d2c5bb3cfa 276 // Pre-load with 4 mpkWh @ 40 mph
TickTock 49:a3d2c5bb3cfa 277 mph[i]=40*timeConstant[i];
TickTock 49:a3d2c5bb3cfa 278 kW[i]=10*timeConstant[i];
TickTock 49:a3d2c5bb3cfa 279 mpkWh[i]=4;
TickTock 49:a3d2c5bb3cfa 280 }
TickTock 49:a3d2c5bb3cfa 281 }
TickTock 49:a3d2c5bb3cfa 282
TickTock 46:73e8716f976f 283 // Read config file
TickTock 46:73e8716f976f 284 readConfig();
TickTock 140:ab3e94eb0227 285 if (brakeMon){
TickTock 140:ab3e94eb0227 286 geiger.attach(&chirp,0.02);
TickTock 140:ab3e94eb0227 287 }
TickTock 108:29b5a760adc2 288 if (repeatPoll) { // enable autopolling if enabled
TickTock 108:29b5a760adc2 289 autoPoll.attach(&autoPollISR,pollInt);
TickTock 108:29b5a760adc2 290 }
TickTock 108:29b5a760adc2 291
TickTock 77:7c136766466c 292 // Start monitors
TickTock 77:7c136766466c 293 can1.monitor(true); // set to snoop mode
TickTock 77:7c136766466c 294 can2.monitor(true); // set to snoop mode
TickTock 77:7c136766466c 295 can1.frequency(500000);
TickTock 77:7c136766466c 296 can2.frequency(500000);
TickTock 120:041edeec08f5 297 can1SleepMode = VP230Sleep; // Turn on Monitor_only Mode
TickTock 120:041edeec08f5 298 can2SleepMode = VP230Sleep; // Turn on Monitor_only Mode
TickTock 77:7c136766466c 299 can1.attach(&recieve1);
TickTock 77:7c136766466c 300 can2.attach(&recieve2);
TickTock 77:7c136766466c 301
TickTock 26:462ccb580472 302 touched=false;
TickTock 26:462ccb580472 303 secsNoTouch=2;
TickTock 2:71b1999a8ea5 304 while (true) {
TickTock 4:8d7759f4fe7a 305 if (!logOpen) { // Open new file if one is not already open
TickTock 131:0d926c080a65 306 if(logEn&&usbEn){ //logging enabled and USB device detected
TickTock 109:3e6f0e8fca0d 307 strftime(fileName, 32, "%m%d%H%M.alc", &t); //mmddhhmm.alc
TickTock 109:3e6f0e8fca0d 308 efr = f_open(&efile,fileName,FA_WRITE|FA_OPEN_ALWAYS);
TickTock 7:17bf9ceaf0aa 309 seconds = time(NULL);
TickTock 7:17bf9ceaf0aa 310 t = *localtime(&seconds) ;
TickTock 94:c3a14b3975d6 311 lastDMode[0]=99;//force refresh
TickTock 94:c3a14b3975d6 312 lastDMode[1]=99;//force refresh
TickTock 109:3e6f0e8fca0d 313 if(efr != FR_OK){
TickTock 109:3e6f0e8fca0d 314 sprintf(sTemp,"\nERR:%d Unable to open %s\n\n\n\n",efr,fileName);
TickTock 93:c2402e8cd0e2 315 printMsg(sTemp); // cannot open alc file
TickTock 7:17bf9ceaf0aa 316 logEn=false;
TickTock 155:f31006516956 317 beep(1000,0.25);
TickTock 109:3e6f0e8fca0d 318 wait_ms(500);
TickTock 155:f31006516956 319 beep(1000,0.25);
TickTock 7:17bf9ceaf0aa 320 } else {
TickTock 7:17bf9ceaf0aa 321 logOpen = true;
TickTock 7:17bf9ceaf0aa 322 readPointer=writePointer;
TickTock 7:17bf9ceaf0aa 323 sprintf(sTemp,"Starting Can Log %s\n",fileName);
TickTock 93:c2402e8cd0e2 324 printMsg(sTemp); // starting alc log file
garygid 69:6bfdfc002036 325
garygid 69:6bfdfc002036 326 logTS(); // Date Time at start
TickTock 93:c2402e8cd0e2 327 logEvent("Starting"); // Log startup msg for testing
garygid 69:6bfdfc002036 328 sprintf(sTemp,"Cr%s",revStr);
TickTock 108:29b5a760adc2 329 logEvent(sTemp); // gg - log firmware version
TickTock 155:f31006516956 330 beep(2000,0.25);
TickTock 7:17bf9ceaf0aa 331 }
TickTock 108:29b5a760adc2 332 }//logging enabled and USB detected
TickTock 15:a359fecf85ba 333 } else { // if (logOpen)
TickTock 73:62ee8eae3a84 334 pointerSep=(writePointer+maxBufLen-readPointer)%maxBufLen;
TickTock 131:0d926c080a65 335 if (pointerSep>(maxBufLen/16)||carCanIdle||!logEn) {
TickTock 7:17bf9ceaf0aa 336 // Dump buffer if > 1/16 full or canbus has stopped
TickTock 117:49883c779a74 337 if (efr != FR_OK) {
TickTock 7:17bf9ceaf0aa 338 logOpen = false;
TickTock 117:49883c779a74 339 printMsg("Failed to append log file.\n"); // failed to append
TickTock 155:f31006516956 340 beep(3000,0.25);
TickTock 155:f31006516956 341 beep(1500,0.25);
TickTock 155:f31006516956 342 beep(750,0.25);
TickTock 155:f31006516956 343 beep(375,0.25);
TickTock 7:17bf9ceaf0aa 344 logEn=false;
TickTock 7:17bf9ceaf0aa 345 } else {
TickTock 7:17bf9ceaf0aa 346 while (readPointer != writePointer) {
TickTock 117:49883c779a74 347 efr=f_write(&efile,&writeBuffer[readPointer][0],13,&bytesRW);
TickTock 117:49883c779a74 348 if(++readPointer >= maxBufLen){
TickTock 117:49883c779a74 349 readPointer=0;
TickTock 117:49883c779a74 350 led4 = !led4;
TickTock 4:8d7759f4fe7a 351 }
TickTock 4:8d7759f4fe7a 352 }
TickTock 7:17bf9ceaf0aa 353 }
TickTock 30:e633a63eb257 354 } // if > 1/16 full, canbus has stopped, or logging stopped
TickTock 30:e633a63eb257 355 if (!logEn) {
TickTock 77:7c136766466c 356 sprintf(sTemp,"Stopping Can Log %s\n",fileName);
TickTock 93:c2402e8cd0e2 357 printMsg(sTemp); // stopping alc log file
TickTock 109:3e6f0e8fca0d 358 f_close(&efile);
TickTock 30:e633a63eb257 359 logOpen=false;
TickTock 77:7c136766466c 360 pointerSep=0;
TickTock 108:29b5a760adc2 361 led4=false;
TickTock 30:e633a63eb257 362 }
TickTock 4:8d7759f4fe7a 363 } // if logOpen
TickTock 132:08748a67280a 364 if (carCanIdle && (evCanIdle || !logOpen) && userIdle && !playbackEn) { // canbus idle --> sleep to save power
TickTock 95:248b3c25a7df 365 if (repeatPoll) { // stop autopolling if enabled
TickTock 95:248b3c25a7df 366 autoPoll.detach();
TickTock 95:248b3c25a7df 367 }
TickTock 111:d1559bb25c43 368 if (logOpen){ //close file to dump buffer
TickTock 111:d1559bb25c43 369 f_close(&efile);
TickTock 134:ad243e4f1a17 370 } else { //detach EVcan so only carcan will trigger wake
TickTock 134:ad243e4f1a17 371 can1.attach(NULL);
TickTock 134:ad243e4f1a17 372 }// if (logOpen)
TickTock 20:3bf176d14b14 373 seconds = time(NULL);
TickTock 20:3bf176d14b14 374 t = *localtime(&seconds) ;
TickTock 21:22bdce9efcb5 375 strftime(sTemp, 40, "Sleeping: %a %m/%d/%Y %X\n", &t);
TickTock 93:c2402e8cd0e2 376 printMsg(sTemp); // sleeping date time
TickTock 25:ddf0ec209f03 377 updateDisplay(0); //Added for turbo3 who has a display override and wants to see the sleep message before going to sleep
TickTock 25:ddf0ec209f03 378 updateDisplay(1);
TickTock 4:8d7759f4fe7a 379 //LPC_RTC->CIIR=0x00; // block RTC interrupts
TickTock 4:8d7759f4fe7a 380 led1=0;
TickTock 4:8d7759f4fe7a 381 led2=0;
TickTock 4:8d7759f4fe7a 382 led3=0;
TickTock 4:8d7759f4fe7a 383 led4=0;
TickTock 4:8d7759f4fe7a 384 dled=0; // turn off display
TickTock 4:8d7759f4fe7a 385 secs = time(NULL); // seconds past 12:00:00 AM 1 Jan 1900
TickTock 132:08748a67280a 386 while (secsNoCarCanMsg>canTimeout && (secsNoEvCanMsg>canTimeout || !logOpen) && !touched) {
TickTock 4:8d7759f4fe7a 387 //DeepPowerDown();
TickTock 12:8e42d7ba8468 388 tt.wfi(); //enable touch interrupt
TickTock 21:22bdce9efcb5 389 //__wfi(); // freeze CPU and wait for interrupt (from canbus or touch)
TickTock 21:22bdce9efcb5 390 Sleep();
TickTock 4:8d7759f4fe7a 391 }
TickTock 135:89986950d501 392 if (!logOpen){ // Re-attach EVcan
TickTock 134:ad243e4f1a17 393 can1.attach(&recieve1);
TickTock 134:ad243e4f1a17 394 }
TickTock 43:e7f6f80590e3 395 secsNoTouch=2;
TickTock 131:0d926c080a65 396 carCanIdle=secsNoCarCanMsg>canTimeout;
TickTock 132:08748a67280a 397 evCanIdle=secsNoEvCanMsg>canTimeout;
TickTock 154:90ea16ca7475 398 dled=ledHi; // turn on display LED
TickTock 20:3bf176d14b14 399 seconds = time(NULL);
TickTock 20:3bf176d14b14 400 t = *localtime(&seconds) ;
TickTock 21:22bdce9efcb5 401 strftime(sTemp, 40, "Waking: %a %m/%d/%Y %X\n", &t);
TickTock 93:c2402e8cd0e2 402 printMsg(sTemp); // wakeup date time
TickTock 4:8d7759f4fe7a 403 if (time(NULL)>(secs+1800)) {
TickTock 110:ffddff3ad2f2 404 if (logOpen){
TickTock 110:ffddff3ad2f2 405 f_close(&efile);
TickTock 110:ffddff3ad2f2 406 logOpen = false; // Start new file if asleep for more than 30 minutes
TickTock 110:ffddff3ad2f2 407 } // if (logOpen)
TickTock 4:8d7759f4fe7a 408 if (secsNoTouch>100) secsNoTouch = 100; // also mostly reset user Idle counter
TickTock 43:e7f6f80590e3 409 } else if (logOpen){ // insert timestamp on each wake if logging enabled (disabled for now)
TickTock 111:d1559bb25c43 410 efr = f_open(&efile,fileName,FA_WRITE|FA_OPEN_ALWAYS);
TickTock 111:d1559bb25c43 411 f_lseek(&efile,0xffffffff); // goto end of file (append existing)
TickTock 93:c2402e8cd0e2 412 logEvent("WakingUp"); // gg - use messeges
garygid 69:6bfdfc002036 413 logTS(); // Date-Time at wakeup
TickTock 4:8d7759f4fe7a 414 }
TickTock 95:248b3c25a7df 415 if (repeatPoll) { // re-enable autopolling if enabled
TickTock 124:0d622967b764 416 autoPoll.attach(&autoPollISR,pollInt);
TickTock 95:248b3c25a7df 417 }
TickTock 136:41a204105511 418 wait5secs=5; // Refresh screen after 5 seconds
TickTock 4:8d7759f4fe7a 419 } // if idle
TickTock 4:8d7759f4fe7a 420
TickTock 15:a359fecf85ba 421 if(touched){ // call touchscreen procedure if touch interrupt detected
TickTock 7:17bf9ceaf0aa 422 lastTouch = tt.get_touch();
TickTock 7:17bf9ceaf0aa 423 lastTouch = tt.to_pixel(lastTouch); // convert to pixel pos
TickTock 40:0e6e71a7323f 424 if((lastTouch.x!=639)&&(lastTouch.x!=319)&&(lastTouch.y!=239)){ // filter phantom touches
TickTock 43:e7f6f80590e3 425 if (userIdle) {
TickTock 43:e7f6f80590e3 426 secsNoTouch=2; // Ignore first touch if user idle
TickTock 43:e7f6f80590e3 427 userIdle=false;
TickTock 40:0e6e71a7323f 428 } else {
TickTock 43:e7f6f80590e3 429 secsNoTouch=0;
TickTock 40:0e6e71a7323f 430 }
TickTock 43:e7f6f80590e3 431 if (lastTouch.x>320){
TickTock 43:e7f6f80590e3 432 whichTouched=1;
TickTock 43:e7f6f80590e3 433 } else {
TickTock 43:e7f6f80590e3 434 whichTouched=0;
TickTock 43:e7f6f80590e3 435 }
TickTock 43:e7f6f80590e3 436 if (whichTouched!=lwt){
TickTock 43:e7f6f80590e3 437 lastDMode[lwt]=99; // Repaint lastTouched
TickTock 43:e7f6f80590e3 438 lwt=whichTouched;
TickTock 43:e7f6f80590e3 439 }
TickTock 43:e7f6f80590e3 440 sMode = 1;
TickTock 22:a43df3905863 441 }
TickTock 22:a43df3905863 442 //sprintf(sTemp,"%d,%d ",lastTouch.x,lastTouch.y);
TickTock 93:c2402e8cd0e2 443 //printMsg(sTemp); // touch x,y - for debug
TickTock 12:8e42d7ba8468 444 touched = false; // clear interrupt flag
TickTock 7:17bf9ceaf0aa 445 }
garygid 54:6ce808d0995e 446 //---------------
garygid 54:6ce808d0995e 447 // gg - 4x4 touch
TickTock 62:ffd15edb5431 448 //unsigned char tScrn = 0 ; // screen 0
garygid 54:6ce808d0995e 449 unsigned char tCol ;
garygid 54:6ce808d0995e 450 unsigned char tRow ;
garygid 54:6ce808d0995e 451
TickTock 4:8d7759f4fe7a 452 if (!userIdle) {
TickTock 4:8d7759f4fe7a 453 if (secsNoTouch<2) {// Recently touched
TickTock 4:8d7759f4fe7a 454 secsNoTouch +=2; // increment to prevent double touch
TickTock 43:e7f6f80590e3 455 sMode = 1;
TickTock 22:a43df3905863 456 //sprintf(sTemp,"button %d %d,%d %d\n",i,buttonX(lastTouch.x,3),buttonY(lastTouch.y,3),lastTouch.x);
TickTock 93:c2402e8cd0e2 457 //printMsg(sTemp); // button parms - for debug
TickTock 23:cd03f9c3395e 458 switch (sMode) {
TickTock 23:cd03f9c3395e 459 case 0: // no select
TickTock 23:cd03f9c3395e 460 break;
TickTock 63:aa3bf6a33635 461 case 1: // select screen
garygid 54:6ce808d0995e 462 //--------------
garygid 54:6ce808d0995e 463 // gg - 4x4 touch
garygid 54:6ce808d0995e 464 tCol = buttonX(lastTouch.x,4) ;
TickTock 62:ffd15edb5431 465 if( tCol >= 4 ){ tCol -= 4; } // touch is on screen 1
garygid 54:6ce808d0995e 466
garygid 54:6ce808d0995e 467 tRow = buttonY(lastTouch.y,4) ;
garygid 54:6ce808d0995e 468
TickTock 63:aa3bf6a33635 469 highlightButton( tCol,tRow, whichTouched, 4,4) ; // gg - highlight
garygid 58:4d06288d75a2 470
TickTock 63:aa3bf6a33635 471 if( tRow == tNavRow ) tRow = 7 ; // gg
garygid 54:6ce808d0995e 472 switch ( (tCol*10) + tRow ) {
garygid 54:6ce808d0995e 473 //---------------------------------
garygid 67:2022fce701d0 474 case 00: // top row, left button on screen 0 or 1
TickTock 42:4533b13b297d 475 if (dMode[whichTouched]==monitorScreen||dMode[whichTouched]==changedScreen) {
garygid 67:2022fce701d0 476 indexOffset=indexOffset>4?indexOffset-4:1;
garygid 67:2022fce701d0 477 } else if (dMode[whichTouched] == indexScreen) { // gg - index
garygid 67:2022fce701d0 478 dMode[whichTouched] = mainScreen ; // GoTo Main Screen
TickTock 73:62ee8eae3a84 479 sMode=0;
TickTock 157:1a100a5ed06f 480 } else if (dMode[whichTouched]==config2Screen) {
TickTock 23:cd03f9c3395e 481 wait_ms(500);
TickTock 37:fea2c1d52c5f 482 tt.background(Black);
TickTock 23:cd03f9c3395e 483 tt.calibrate();
TickTock 42:4533b13b297d 484 } else if (dMode[whichTouched]==playbackScreen) { // slower
TickTock 36:dbd39c315258 485 playbackInt *=2;
TickTock 36:dbd39c315258 486 if(playbackEn){
TickTock 36:dbd39c315258 487 playback.detach();
TickTock 36:dbd39c315258 488 playback.attach(&playbackISR,playbackInt);
TickTock 36:dbd39c315258 489 }
TickTock 62:ffd15edb5431 490 } else {
TickTock 62:ffd15edb5431 491 lastDMode[whichTouched]=99;//repaint to clear highlight
TickTock 23:cd03f9c3395e 492 }
TickTock 23:cd03f9c3395e 493 break;
garygid 54:6ce808d0995e 494 //-----------------------------------------------
garygid 67:2022fce701d0 495 case 10: // 1,0 (col left of center,top row) on screen 0 or 1
TickTock 42:4533b13b297d 496 if (dMode[whichTouched]==changedScreen) {
TickTock 23:cd03f9c3395e 497 for(j=0;j<100;j++) msgChanged[j]=0; // clear changed data
TickTock 42:4533b13b297d 498 lastDMode[whichTouched]=99;//force refresh
TickTock 169:84d790ac18a2 499 sMode=0;
garygid 67:2022fce701d0 500 } else if (dMode[whichTouched] == indexScreen) { // gg - index
TickTock 73:62ee8eae3a84 501 sMode=0;
garygid 67:2022fce701d0 502 dMode[whichTouched] = brakeScreen ; // GoTo Brake Screen
TickTock 42:4533b13b297d 503 } else if (dMode[whichTouched]==cpScreen) {
TickTock 78:a383971fe02f 504 reqMsgCnt=0;
TickTock 79:68f0dd8d1f19 505 msgReq.attach(&sendReq,0.015);
TickTock 48:d1ce92104a1f 506 } else if (dMode[whichTouched]==cpHistScreen) { // gg - hist
TickTock 78:a383971fe02f 507 reqMsgCnt=0;
TickTock 79:68f0dd8d1f19 508 msgReq.attach(&sendReq,0.015);
TickTock 48:d1ce92104a1f 509 } else if (dMode[whichTouched]==cpBarScreen) { // gg - cpbars
TickTock 78:a383971fe02f 510 reqMsgCnt=0;
TickTock 79:68f0dd8d1f19 511 msgReq.attach(&sendReq,0.015);
leafman 98:9f8bab96edff 512 } else if (dMode[whichTouched]==configScreen) {
TickTock 23:cd03f9c3395e 513 mbed_reset();
TickTock 157:1a100a5ed06f 514 } else if (dMode[whichTouched]==config2Screen) { // reset DTE Max/Min
TickTock 158:059abeb44ba1 515 maxTripEff = 0;
TickTock 158:059abeb44ba1 516 minTripEff = 5;
TickTock 161:71ac85d11f03 517 beep(2000,0.25);
TickTock 184:5ca7b78297fe 518 for(i=0;i<300;i++){ // initialize wh lookup
TickTock 184:5ca7b78297fe 519 wh[i]=i*kWperGid*1000;
TickTock 184:5ca7b78297fe 520 }
TickTock 42:4533b13b297d 521 } else if (dMode[whichTouched]==playbackScreen) { // pause/unpause
TickTock 36:dbd39c315258 522 playbackEn=!playbackEn;
TickTock 36:dbd39c315258 523 if(playbackEn){
TickTock 36:dbd39c315258 524 playback.attach(&playbackISR,playbackInt);
TickTock 62:ffd15edb5431 525 } else {
TickTock 36:dbd39c315258 526 playback.detach();
TickTock 36:dbd39c315258 527 }
TickTock 62:ffd15edb5431 528 } else {
TickTock 62:ffd15edb5431 529 lastDMode[whichTouched]=99;//repaint to clear highlight
TickTock 23:cd03f9c3395e 530 }
TickTock 62:ffd15edb5431 531
TickTock 23:cd03f9c3395e 532 break;
garygid 54:6ce808d0995e 533 //--------------------------------------
garygid 54:6ce808d0995e 534 case 20: // col 2 and row 0 on either screen 0 or 1
TickTock 42:4533b13b297d 535 if (dMode[whichTouched]==monitorScreen||dMode[whichTouched]==changedScreen) {
TickTock 23:cd03f9c3395e 536 indexOffset=indexOffset<77?indexOffset+4:80;
garygid 67:2022fce701d0 537 } else if (dMode[whichTouched] == indexScreen) { // gg - index
garygid 67:2022fce701d0 538 dMode[whichTouched] = effScreen ; // GoTo EFF Screen
TickTock 73:62ee8eae3a84 539 sMode=0;
leafman 98:9f8bab96edff 540 } else if (dMode[whichTouched]==configScreen) {
TickTock 143:88b5155622a5 541 dMode[whichTouched]=mainScreen;
TickTock 169:84d790ac18a2 542 //write efficiency history data
TickTock 169:84d790ac18a2 543 hfile = fopen("/local/ehist.cny", "w");
TickTock 169:84d790ac18a2 544 if (hfile!=NULL){ // found a efficiency history file
TickTock 169:84d790ac18a2 545 for(i=0;i<39;i++){
TickTock 169:84d790ac18a2 546 fprintf(hfile,"%f %f\r\n",mph[i],kW[i]);
TickTock 169:84d790ac18a2 547 }
TickTock 169:84d790ac18a2 548 fprintf(hfile,"%f %f\r\n",maxTripEff,minTripEff); // Save max and min
TickTock 169:84d790ac18a2 549 fprintf(hfile,"%f \r\n",Resr); // Save series resistance
TickTock 169:84d790ac18a2 550 fprintf(hfile,"%f %f\r\n",maxTripMiles,minTripMiles); // Save max and min
TickTock 169:84d790ac18a2 551 fprintf(hfile,"%f %f\r\n",maxTripkWh,minTripkWh); // Save max and min
TickTock 169:84d790ac18a2 552 fprintf(hfile,"%f %f\r\n",maxTripCCkWh,minTripCCkWh); // Save max and min
TickTock 180:5fdeeb86f3a3 553 for(i=0;i<300;i++){
TickTock 180:5fdeeb86f3a3 554 fprintf(hfile,"%f\r\n",wh[i]);
TickTock 180:5fdeeb86f3a3 555 }
TickTock 169:84d790ac18a2 556 fclose(hfile);
TickTock 169:84d790ac18a2 557 }
TickTock 169:84d790ac18a2 558 beep(2000,0.25);
TickTock 184:5ca7b78297fe 559 saveConfig();
TickTock 184:5ca7b78297fe 560 beep(2000,0.25);
TickTock 169:84d790ac18a2 561 } else if (dMode[whichTouched]==config2Screen) {
TickTock 169:84d790ac18a2 562 showHealth = !showHealth;
TickTock 42:4533b13b297d 563 } else if (dMode[whichTouched]==playbackScreen) { // faster
TickTock 36:dbd39c315258 564 if(playbackInt>.002){
TickTock 36:dbd39c315258 565 playbackInt/=2;
TickTock 36:dbd39c315258 566 if(playbackEn){
TickTock 36:dbd39c315258 567 playback.detach();
TickTock 36:dbd39c315258 568 playback.attach(&playbackISR,playbackInt);
TickTock 36:dbd39c315258 569 }
TickTock 36:dbd39c315258 570 }
TickTock 86:d1c9e8ac1c4b 571 } else {
TickTock 62:ffd15edb5431 572 lastDMode[whichTouched]=99;//repaint to clear highlight
TickTock 23:cd03f9c3395e 573 }
TickTock 62:ffd15edb5431 574
TickTock 23:cd03f9c3395e 575 break;
garygid 65:821fc79cd7fe 576
garygid 67:2022fce701d0 577 case 30: // right-most on top row
garygid 65:821fc79cd7fe 578
TickTock 157:1a100a5ed06f 579 if (dMode[whichTouched]==config2Screen) {
garygid 65:821fc79cd7fe 580 // step through skins
garygid 65:821fc79cd7fe 581 if( skin < maxSkin ) skin += 1 ;
garygid 65:821fc79cd7fe 582 else skin = 0 ;
garygid 65:821fc79cd7fe 583
garygid 65:821fc79cd7fe 584 // repaint both screens, I think
garygid 65:821fc79cd7fe 585 lastDMode[whichTouched]=99;//repaint to clear highlight
garygid 65:821fc79cd7fe 586 // and re-paint the other screen too, to see new skin there
garygid 65:821fc79cd7fe 587 lastDMode[whichTouched ^ 1]=99; // repaint other screen (^ = XOR)
garygid 67:2022fce701d0 588 } else if (dMode[whichTouched] == indexScreen) { // gg - index
TickTock 122:138a40892a4c 589 dMode[whichTouched] = healthScreen ; // Goto health screen
TickTock 73:62ee8eae3a84 590 sMode=0;
TickTock 169:84d790ac18a2 591 } else if (dMode[whichTouched] == testScreen) { // gg -
TickTock 158:059abeb44ba1 592 clearTest=true;
TickTock 158:059abeb44ba1 593 } else { // top-right corner always mute/unmute unless used by specific screen
TickTock 154:90ea16ca7475 594 enableSound = !enableSound;
TickTock 155:f31006516956 595 if(!enableSound) spkr=0;
garygid 65:821fc79cd7fe 596 }
garygid 65:821fc79cd7fe 597
garygid 65:821fc79cd7fe 598 break;
garygid 54:6ce808d0995e 599 //----------------------------------
garygid 54:6ce808d0995e 600 //----------------------------------
garygid 67:2022fce701d0 601 case 01: // left col middle row
leafman 98:9f8bab96edff 602 if (dMode[whichTouched]==configScreen) {
TickTock 23:cd03f9c3395e 603 logEn = !logEn;
garygid 67:2022fce701d0 604 } else if (dMode[whichTouched] == indexScreen) { // gg - index
TickTock 73:62ee8eae3a84 605 dMode[whichTouched] = cpScreen ; // GoTo CP Data Screen
TickTock 73:62ee8eae3a84 606 sMode=0;
TickTock 42:4533b13b297d 607 } else if (dMode[whichTouched]==dateScreen){
TickTock 131:0d926c080a65 608 dtMode=(dtMode<5)?dtMode+1:0;
TickTock 42:4533b13b297d 609 lastDMode[whichTouched]=99;
TickTock 62:ffd15edb5431 610 } else {
TickTock 62:ffd15edb5431 611 lastDMode[whichTouched]=99;//repaint to clear highlight
TickTock 23:cd03f9c3395e 612 }
TickTock 62:ffd15edb5431 613
TickTock 23:cd03f9c3395e 614 break;
garygid 54:6ce808d0995e 615 //------------------------------
TickTock 23:cd03f9c3395e 616 case 11:
leafman 98:9f8bab96edff 617 if (dMode[whichTouched]==configScreen){
TickTock 77:7c136766466c 618 repeatPoll = !repeatPoll;
TickTock 33:a277743ebdeb 619 if (repeatPoll) {
TickTock 36:dbd39c315258 620 autoPoll.attach(&autoPollISR,pollInt);
TickTock 33:a277743ebdeb 621 } else {
TickTock 36:dbd39c315258 622 autoPoll.detach();
TickTock 33:a277743ebdeb 623 }
garygid 67:2022fce701d0 624 } else if (dMode[whichTouched] == indexScreen) { // gg - index
garygid 67:2022fce701d0 625 dMode[whichTouched] = cpHistScreen ; // GoTo CP Hist Screen
TickTock 73:62ee8eae3a84 626 sMode=0;
TickTock 42:4533b13b297d 627 } else if (dMode[whichTouched]==playbackScreen) {
TickTock 36:dbd39c315258 628 // Start/stop playback
TickTock 36:dbd39c315258 629 if(!playbackOpen){
TickTock 131:0d926c080a65 630 if(!carCanIdle){
TickTock 131:0d926c080a65 631 printMsg("Cannot playback while connected to canbus\n");
TickTock 131:0d926c080a65 632 }else if(!logOpen){
TickTock 109:3e6f0e8fca0d 633 efr = f_open(&efile,"playback.alc",FA_READ|FA_OPEN_EXISTING);
TickTock 50:83d5864c64a0 634 lastDMode[whichTouched]=99;//force refresh
TickTock 109:3e6f0e8fca0d 635 if(efr != FR_OK){
TickTock 116:5cd72bae7c12 636 printMsg("Unable to open /usb/playback.alc\n"); // no playback.alc
TickTock 155:f31006516956 637 beep(1000,0.25);
TickTock 36:dbd39c315258 638 } else {
TickTock 36:dbd39c315258 639 playbackOpen = true;
TickTock 50:83d5864c64a0 640 playbackEn=true;
TickTock 50:83d5864c64a0 641 playback.attach(&playbackISR,playbackInt);
TickTock 116:5cd72bae7c12 642 printMsg("Starting playback\n"); // start playback
TickTock 155:f31006516956 643 beep(2000,0.25);
TickTock 138:a2f5af85ed0d 644 can1.attach(NULL);// Stop recieving EVCAN data
TickTock 138:a2f5af85ed0d 645 can2.attach(NULL);// Stop recieving CARCAN data
TickTock 36:dbd39c315258 646 }
TickTock 36:dbd39c315258 647 } else {
TickTock 117:49883c779a74 648 printMsg("Must stop logging first\n");
TickTock 36:dbd39c315258 649 }
TickTock 36:dbd39c315258 650 } else {
TickTock 36:dbd39c315258 651 playback.detach();
TickTock 109:3e6f0e8fca0d 652 f_close(&efile);
TickTock 36:dbd39c315258 653 playbackOpen=false;
TickTock 50:83d5864c64a0 654 playbackEn=false;
TickTock 138:a2f5af85ed0d 655 can1.attach(&recieve1);// Restore EVCAN data recieve
TickTock 138:a2f5af85ed0d 656 can2.attach(&recieve2);// Restore EVCAN data recieve
TickTock 42:4533b13b297d 657 lastDMode[whichTouched]=99;
TickTock 36:dbd39c315258 658 }
TickTock 42:4533b13b297d 659 } else if (dMode[whichTouched]==dateScreen){
TickTock 25:ddf0ec209f03 660 upDate(dtMode,true);
TickTock 42:4533b13b297d 661 lastDMode[whichTouched]=99;
TickTock 62:ffd15edb5431 662 } else {
TickTock 62:ffd15edb5431 663 lastDMode[whichTouched]=99;//repaint to clear highlight
TickTock 25:ddf0ec209f03 664 }
TickTock 62:ffd15edb5431 665
TickTock 23:cd03f9c3395e 666 break;
garygid 54:6ce808d0995e 667 //---------------------------------
garygid 54:6ce808d0995e 668 case 21: // col 2 row 1
leafman 98:9f8bab96edff 669 if (dMode[whichTouched]==configScreen) { // gg - Batt Log Enable Button
TickTock 48:d1ce92104a1f 670 yesBattLog = !yesBattLog;
garygid 67:2022fce701d0 671 } else if (dMode[whichTouched] == indexScreen) { // gg - index
garygid 67:2022fce701d0 672 dMode[whichTouched] = cpBarScreen ; // GoTo CP Bars Screen
TickTock 73:62ee8eae3a84 673 sMode=0;
TickTock 48:d1ce92104a1f 674 } else if (dMode[whichTouched]==dateScreen){
TickTock 25:ddf0ec209f03 675 upDate(dtMode,false);
TickTock 42:4533b13b297d 676 lastDMode[whichTouched]=99;
TickTock 62:ffd15edb5431 677 } else {
TickTock 62:ffd15edb5431 678 lastDMode[whichTouched]=99;//repaint to clear highlight
TickTock 25:ddf0ec209f03 679 }
TickTock 62:ffd15edb5431 680
TickTock 23:cd03f9c3395e 681 break;
garygid 54:6ce808d0995e 682
garygid 87:46ac3f2519d6 683 case 31: // col 3 row 1
TickTock 157:1a100a5ed06f 684 if (dMode[whichTouched]==config2Screen) { // gg - Batt Log Enable Button
garygid 87:46ac3f2519d6 685 debugMode = !debugMode;
leafman 98:9f8bab96edff 686 } else if (dMode[whichTouched] == indexScreen) { // gg - index
TickTock 152:a4d66901785d 687 dMode[whichTouched] = configScreen ; // GoTo Config Screen
TickTock 177:6fda79c2fda1 688 } else if (dMode[whichTouched]==tripScreen) { // Cancel day trip meter
TickTock 177:6fda79c2fda1 689 ignoreDayData=true;
TickTock 177:6fda79c2fda1 690 lastDMode[whichTouched]=99;//repaint to clear highlight
TickTock 152:a4d66901785d 691 } else if ((dMode[whichTouched]==dateScreen)&&accOn){
TickTock 160:905fe45ed54b 692 syncDone=false; // initiate clock sync
TickTock 152:a4d66901785d 693 lastDMode[whichTouched]=99;
TickTock 187:af5ba64c0afe 694 } else if (dMode[whichTouched]==configScreen) {
TickTock 187:af5ba64c0afe 695 if(!headlights){
TickTock 187:af5ba64c0afe 696 ledHi += 0.05;
TickTock 187:af5ba64c0afe 697 if (ledHi>1.0) ledHi=1.0;
TickTock 187:af5ba64c0afe 698 } else {
TickTock 187:af5ba64c0afe 699 ledLo += 0.05;
TickTock 187:af5ba64c0afe 700 if (ledLo>1.0) ledLo=1.0;
TickTock 187:af5ba64c0afe 701 }
garygid 87:46ac3f2519d6 702 } else {
garygid 87:46ac3f2519d6 703 lastDMode[whichTouched]=99;//repaint to clear highlight
garygid 87:46ac3f2519d6 704 }
garygid 87:46ac3f2519d6 705 break;
garygid 87:46ac3f2519d6 706
garygid 54:6ce808d0995e 707 //-----------------------------------
garygid 67:2022fce701d0 708 case 02: // left col, bottom row (not nav)
garygid 67:2022fce701d0 709 if (dMode[whichTouched] == indexScreen) { // gg - index
leafman 98:9f8bab96edff 710 dMode[whichTouched] = playbackScreen ; // GoTo Playback Screen
leafman 98:9f8bab96edff 711 } else if (dMode[whichTouched]==configScreen) {
TickTock 140:ab3e94eb0227 712 brakeMon = !brakeMon;
TickTock 140:ab3e94eb0227 713 if(brakeMon){
TickTock 140:ab3e94eb0227 714 geiger.attach(&chirp,0.02);
TickTock 140:ab3e94eb0227 715 }else{
TickTock 140:ab3e94eb0227 716 geiger.detach();
TickTock 140:ab3e94eb0227 717 }
TickTock 158:059abeb44ba1 718 } else if (dMode[whichTouched]==config2Screen) {
TickTock 158:059abeb44ba1 719 autoSync = !autoSync;
garygid 87:46ac3f2519d6 720 } else {
garygid 87:46ac3f2519d6 721 lastDMode[whichTouched]=99;//repaint to clear highlight
garygid 87:46ac3f2519d6 722 }
garygid 67:2022fce701d0 723 break;
garygid 67:2022fce701d0 724
garygid 67:2022fce701d0 725 case 12: // left-middle col, bottom row (not nav)
TickTock 158:059abeb44ba1 726 if (dMode[whichTouched]==configScreen) {
TickTock 158:059abeb44ba1 727 regenMon = !regenMon;
TickTock 158:059abeb44ba1 728 } else if (dMode[whichTouched]==config2Screen) { // gg - index
leafman 98:9f8bab96edff 729 dMode[whichTouched] = dateScreen ; // GoTo Set Date/Time Screen
garygid 87:46ac3f2519d6 730 } else {
garygid 87:46ac3f2519d6 731 lastDMode[whichTouched]=99;//repaint to clear highlight
garygid 87:46ac3f2519d6 732 }
garygid 67:2022fce701d0 733 break;
garygid 67:2022fce701d0 734
garygid 67:2022fce701d0 735 case 22: // right-middle col, bottom row (not nav)
TickTock 158:059abeb44ba1 736 if (dMode[whichTouched]==indexScreen) { // gg - index
leafman 98:9f8bab96edff 737 dMode[whichTouched] = logScreen ;
TickTock 169:84d790ac18a2 738 sMode=0;
TickTock 159:577e9d015693 739 } else if (dMode[whichTouched]==configScreen) {
TickTock 159:577e9d015693 740 heaterMon = !heaterMon;
TickTock 157:1a100a5ed06f 741 } else if (dMode[whichTouched]==config2Screen) {
TickTock 169:84d790ac18a2 742 updateConfig();
TickTock 169:84d790ac18a2 743 lastDMode[whichTouched]=99;//force refresh
TickTock 169:84d790ac18a2 744 sMode=0;
garygid 87:46ac3f2519d6 745 } else {
garygid 87:46ac3f2519d6 746 lastDMode[whichTouched]=99;//repaint to clear highlight
garygid 87:46ac3f2519d6 747 }
garygid 67:2022fce701d0 748 break;
TickTock 72:f9a6faa28873 749
leafman 98:9f8bab96edff 750 case 32: // right col, bottom row (not nav)
TickTock 158:059abeb44ba1 751 if (dMode[whichTouched]==config2Screen) {
TickTock 114:3f8c59a8a2b9 752 logEn=false;
leafman 98:9f8bab96edff 753 updateFirmware();
TickTock 158:059abeb44ba1 754 } else if (dMode[whichTouched]==tripScreen) {
TickTock 177:6fda79c2fda1 755 // Reset custom trip meter
TickTock 108:29b5a760adc2 756 miles_trip[2]=0;
TickTock 108:29b5a760adc2 757 kWh_trip[2]=0;
TickTock 167:58d4edf403d4 758 CCkWh_trip[2]=0;
TickTock 73:62ee8eae3a84 759 sMode=0;
TickTock 108:29b5a760adc2 760 lastDMode[whichTouched]=99;//repaint to clear highlight
TickTock 158:059abeb44ba1 761 } else if (dMode[whichTouched]==indexScreen) {
TickTock 108:29b5a760adc2 762 dMode[whichTouched] = tripScreen ;
TickTock 169:84d790ac18a2 763 sMode=0;
TickTock 152:a4d66901785d 764 } else if (dMode[whichTouched]==dateScreen){
TickTock 152:a4d66901785d 765 autoSync=!autoSync; // toggle autoSync mode
TickTock 152:a4d66901785d 766 lastDMode[whichTouched]=99;
TickTock 187:af5ba64c0afe 767 } else if (dMode[whichTouched]==configScreen) {
TickTock 187:af5ba64c0afe 768 if(!headlights){
TickTock 187:af5ba64c0afe 769 ledHi -= 0.05;
TickTock 187:af5ba64c0afe 770 if (ledHi<0) ledHi=0;
TickTock 187:af5ba64c0afe 771 } else {
TickTock 187:af5ba64c0afe 772 ledLo -= 0.05;
TickTock 187:af5ba64c0afe 773 if (ledLo<0) ledLo=0;
TickTock 187:af5ba64c0afe 774 }
leafman 98:9f8bab96edff 775 } else {
garygid 87:46ac3f2519d6 776 lastDMode[whichTouched]=99;//repaint to clear highlight
TickTock 72:f9a6faa28873 777 }
TickTock 72:f9a6faa28873 778 break;
TickTock 72:f9a6faa28873 779
garygid 67:2022fce701d0 780 //-----------------------------------
garygid 54:6ce808d0995e 781 //-----------------------------------
garygid 54:6ce808d0995e 782 // Prev Navigation
garygid 54:6ce808d0995e 783 case 07: // col 0 row tNavRow
TickTock 42:4533b13b297d 784 dMode[whichTouched]=dMode[whichTouched]>0?dMode[whichTouched]-1:maxScreens;
TickTock 22:a43df3905863 785 break;
garygid 54:6ce808d0995e 786 //-----------------------------------
garygid 54:6ce808d0995e 787 // Select Screen Navigation
garygid 54:6ce808d0995e 788 case 17:
TickTock 43:e7f6f80590e3 789 sMode=0;
TickTock 43:e7f6f80590e3 790 lastDMode[whichTouched]=99; // Repaint
TickTock 22:a43df3905863 791 break;
garygid 54:6ce808d0995e 792 //-----------------------------------
garygid 54:6ce808d0995e 793 // Index Navigation
garygid 54:6ce808d0995e 794 case 27: // col 2 row tNavRow
garygid 67:2022fce701d0 795 dMode[whichTouched]= indexScreen ; // gg - index
garygid 54:6ce808d0995e 796 break;
garygid 54:6ce808d0995e 797 //------------------------------------
garygid 54:6ce808d0995e 798 // Next Navigation
garygid 54:6ce808d0995e 799 case 37: // lower right on Nav Line gg - move next
TickTock 42:4533b13b297d 800 dMode[whichTouched]=dMode[whichTouched]<maxScreens?dMode[whichTouched]+1:0;
TickTock 22:a43df3905863 801 break;
garygid 54:6ce808d0995e 802 //------------------------------------
garygid 54:6ce808d0995e 803 //------------------------------------
TickTock 22:a43df3905863 804 default:
TickTock 62:ffd15edb5431 805 lastDMode[whichTouched]=99;//repaint to clear highlight
TickTock 25:ddf0ec209f03 806 break;
TickTock 25:ddf0ec209f03 807 }
TickTock 23:cd03f9c3395e 808 break;
TickTock 23:cd03f9c3395e 809 case 2: // numpad
TickTock 23:cd03f9c3395e 810 break;
TickTock 23:cd03f9c3395e 811 case 3:
TickTock 23:cd03f9c3395e 812 break;
TickTock 23:cd03f9c3395e 813 default:
TickTock 23:cd03f9c3395e 814 break;
TickTock 23:cd03f9c3395e 815 } // case sMode
TickTock 22:a43df3905863 816 } //recently touched
TickTock 4:8d7759f4fe7a 817 } else { // userIdle
TickTock 8:67eed72f3e10 818 if(sMode==1){
TickTock 8:67eed72f3e10 819 sMode=0;
TickTock 43:e7f6f80590e3 820 lastDMode[whichTouched]=99;
TickTock 8:67eed72f3e10 821 }
TickTock 4:8d7759f4fe7a 822 }
TickTock 34:4751a8259b18 823
TickTock 153:e94cfe3c339c 824 // Sound tone on power reversal
TickTock 153:e94cfe3c339c 825 idir=(kW[0]>0)?true:false;
TickTock 155:f31006516956 826 if(regenMon){
TickTock 153:e94cfe3c339c 827 if (idir&&!lidir){
TickTock 155:f31006516956 828 beep(800,0.02); // Started sinking current
TickTock 153:e94cfe3c339c 829 }else if(!idir&&lidir){
TickTock 155:f31006516956 830 beep(3200,0.02); // Started regen
TickTock 153:e94cfe3c339c 831 }
TickTock 153:e94cfe3c339c 832 }
TickTock 154:90ea16ca7475 833 lidir=idir;
TickTock 153:e94cfe3c339c 834
TickTock 34:4751a8259b18 835 if(tick){ // Executes once a second
TickTock 108:29b5a760adc2 836 tick=false;
TickTock 164:46ed06263b0e 837 lCCon = CCon;
TickTock 161:71ac85d11f03 838 CCkW = (lastMsg[indexLastMsg[0x510]].data[3]&0x7f)*0.125;
TickTock 164:46ed06263b0e 839 if(lastMsg[indexLastMsg[0x510]].data[3]&0x80){
TickTock 164:46ed06263b0e 840 CCon=true; // On when button pushed
TickTock 164:46ed06263b0e 841 } else if(CCkW==0) {
TickTock 164:46ed06263b0e 842 CCon=false; // Off when power drops back to zero
TickTock 164:46ed06263b0e 843 }
TickTock 164:46ed06263b0e 844 if(!CCon && lCCon){
TickTock 164:46ed06263b0e 845 lastDMode[0]=99;//force refresh
TickTock 164:46ed06263b0e 846 lastDMode[1]=99;//force refresh
TickTock 164:46ed06263b0e 847 }
TickTock 93:c2402e8cd0e2 848 headlights = (lastMsg[indexLastMsg[0x358]].data[1]&0x80)?true:false; // headlight/turn signal indicator
TickTock 160:905fe45ed54b 849 if(heaterOn){
TickTock 160:905fe45ed54b 850 lHeaterOn=true; // Only indicate heater once per power cycle
TickTock 160:905fe45ed54b 851 }
TickTock 184:5ca7b78297fe 852 heaterOn =((lastMsg[indexLastMsg[0x54f]].data[5]&0x3f)>2)?true:false;
TickTock 159:577e9d015693 853 if(heaterMon && heaterOn && !lHeaterOn){ //Heat on alarm
TickTock 160:905fe45ed54b 854 beep3(800,0.25,1200,0.25,1600,0.25);
TickTock 160:905fe45ed54b 855 //beep(1600,0.5);
TickTock 159:577e9d015693 856 }
TickTock 148:6e3b9135fad2 857 if(accOn&&indexLastMsg[0x355]>0){
TickTock 141:cf13a632ddb5 858 miles_kmbar = (lastMsg[indexLastMsg[0x355]].data[4]&0x20)?true:false; // indicates selected distance units
TickTock 141:cf13a632ddb5 859 metric = !miles_kmbar;
TickTock 141:cf13a632ddb5 860 }
TickTock 41:8d4609ea7259 861 accV=floor(mon12V*scale12V*10+0.5)/10; //Round to nearest 10th
TickTock 172:53548bf8bf85 862 accOn=(playbackOpen||(accV>5))?true:false;
TickTock 131:0d926c080a65 863 moving=(mph[0]>0.1);
TickTock 151:3047ebb3c9a8 864 charging=(lastMsg[indexLastMsg[0x5bf]].data[2]>0)?true:false; // FF when charging
TickTock 134:ad243e4f1a17 865 if (laccOn&&!accOn){ // Car turned off
TickTock 177:6fda79c2fda1 866 dailyGids += startGids-((lastMsg[indexLastMsg[0x5bc]].data[0]<<2)+(lastMsg[indexLastMsg[0x5bc]].data[1]>>6));
TickTock 160:905fe45ed54b 867 lHeaterOn=false;
TickTock 172:53548bf8bf85 868 if (showHealth&&!playbackOpen){
TickTock 175:0357b4159b40 869 if (saveDmode[0]==99){
TickTock 175:0357b4159b40 870 saveDmode[0]=dMode[0];
TickTock 175:0357b4159b40 871 saveDmode[1]=dMode[1];
TickTock 134:ad243e4f1a17 872 }
TickTock 134:ad243e4f1a17 873 dMode[0]=healthScreen;
TickTock 175:0357b4159b40 874 dMode[1]=tripScreen;
TickTock 135:89986950d501 875 secsNoTouch=2;// Keep display on a few seconds
TickTock 134:ad243e4f1a17 876 sMode=0;
TickTock 134:ad243e4f1a17 877 userIdle=false;
TickTock 134:ad243e4f1a17 878 }
TickTock 108:29b5a760adc2 879 if (repeatPoll) { // Log on shutdown if autopoll enabled
TickTock 108:29b5a760adc2 880 tripLog(); // Write trip log on powerdown
TickTock 108:29b5a760adc2 881 }
TickTock 49:a3d2c5bb3cfa 882 //write efficiency history data
TickTock 97:a25940fd7b5b 883 hfile = fopen("/local/ehist.cny", "w");
TickTock 97:a25940fd7b5b 884 if (hfile!=NULL){ // found a efficiency history file
TickTock 49:a3d2c5bb3cfa 885 for(i=0;i<39;i++){
TickTock 97:a25940fd7b5b 886 fprintf(hfile,"%f %f\r\n",mph[i],kW[i]);
TickTock 49:a3d2c5bb3cfa 887 }
TickTock 134:ad243e4f1a17 888 fprintf(hfile,"%f %f\r\n",maxTripEff,minTripEff); // Save max and min
TickTock 155:f31006516956 889 fprintf(hfile,"%f \r\n",Resr); // Save series resistance
TickTock 167:58d4edf403d4 890 fprintf(hfile,"%f %f\r\n",maxTripMiles,minTripMiles); // Save max and min
TickTock 167:58d4edf403d4 891 fprintf(hfile,"%f %f\r\n",maxTripkWh,minTripkWh); // Save max and min
TickTock 167:58d4edf403d4 892 fprintf(hfile,"%f %f\r\n",maxTripCCkWh,minTripCCkWh); // Save max and min
TickTock 180:5fdeeb86f3a3 893 for(i=0;i<300;i++){
TickTock 180:5fdeeb86f3a3 894 fprintf(hfile,"%f\r\n",wh[i]);
TickTock 180:5fdeeb86f3a3 895 }
TickTock 97:a25940fd7b5b 896 fclose(hfile);
TickTock 49:a3d2c5bb3cfa 897 }
TickTock 49:a3d2c5bb3cfa 898 }
TickTock 134:ad243e4f1a17 899 if (!laccOn&&accOn){ // Car turned on
TickTock 160:905fe45ed54b 900 lHeaterOn=false;
TickTock 177:6fda79c2fda1 901 getGids=true;
TickTock 108:29b5a760adc2 902 miles_trip[0]=0;
TickTock 108:29b5a760adc2 903 kWh_trip[0]=0;
TickTock 167:58d4edf403d4 904 CCkWh_trip[0]=0;
TickTock 176:9c19f9856c76 905 seconds = time(NULL);
TickTock 176:9c19f9856c76 906 t = *localtime(&seconds);
TickTock 183:a1fba6f76e69 907 if(miles_trip[1]<1){ // charged since last trip
TickTock 184:5ca7b78297fe 908
TickTock 184:5ca7b78297fe 909 // Adjust wh lookup with whpg data
TickTock 180:5fdeeb86f3a3 910 maxWhpg=0;
TickTock 180:5fdeeb86f3a3 911 minWh=0;
TickTock 180:5fdeeb86f3a3 912 whOff=0;
TickTock 180:5fdeeb86f3a3 913 for(i=1;i<300;i++){
TickTock 184:5ca7b78297fe 914 if(whpg[i]>maxWhpg){ //Find maxWhpg and associated Wh
TickTock 184:5ca7b78297fe 915 maxWhpg = (float) whpg[i];
TickTock 184:5ca7b78297fe 916 minWh = wh[i];
TickTock 182:10017d74de67 917 if(debugMode){
TickTock 184:5ca7b78297fe 918 sprintf(sTemp,"maxWhpg=%3.1f; minWh=%3.1f\n", maxWhpg, minWh);
TickTock 184:5ca7b78297fe 919 printMsg(sTemp);
TickTock 182:10017d74de67 920 }
TickTock 180:5fdeeb86f3a3 921 }
TickTock 184:5ca7b78297fe 922 if(whpg[i]>0){ // Compute adjustment to measured range
TickTock 184:5ca7b78297fe 923 whOff = (maxWhpg-(float)whpg[i])-(wh[i]-minWh);
TickTock 184:5ca7b78297fe 924 }else if(whpg[i-1]>0){ // Compute final offset for rest of range
TickTock 184:5ca7b78297fe 925 whOff = maxWhpg-(wh[i]-minWh);
TickTock 184:5ca7b78297fe 926 if(debugMode){
TickTock 184:5ca7b78297fe 927 sprintf(sTemp,"whOff=%3.1f\n", whOff);
TickTock 184:5ca7b78297fe 928 printMsg(sTemp);
TickTock 180:5fdeeb86f3a3 929 }
TickTock 180:5fdeeb86f3a3 930 }
TickTock 184:5ca7b78297fe 931 wh[i] += 0.1*whOff; // Add offset; use last known good offset when no data
TickTock 184:5ca7b78297fe 932 whpg[i-1]=0;
TickTock 181:396fdcceefd2 933 }
TickTock 184:5ca7b78297fe 934 whpg[299]=0;
TickTock 184:5ca7b78297fe 935
TickTock 184:5ca7b78297fe 936 // Check and reset daily efficiency if charged since last trip and at least 24 hours has past
TickTock 183:a1fba6f76e69 937 if((t.tm_yday>lt.tm_yday)&&(t.tm_hour>effCheckTime)){
TickTock 183:a1fba6f76e69 938 if (!ignoreDayData&&(miles_trip[3]>15)){ // Ignore low mileage data
TickTock 183:a1fba6f76e69 939 curEff = miles_trip[3]/kWh_trip[3]; // Get current daily efficiency
TickTock 183:a1fba6f76e69 940 if (maxTripEff<curEff) {
TickTock 183:a1fba6f76e69 941 maxTripEff=curEff;
TickTock 183:a1fba6f76e69 942 maxTripMiles=miles_trip[3];
TickTock 183:a1fba6f76e69 943 maxTripkWh=kWh_trip[3];
TickTock 183:a1fba6f76e69 944 maxTripCCkWh=CCkWh_trip[3];
TickTock 183:a1fba6f76e69 945 printMsg("New max efficiency.\n");
TickTock 183:a1fba6f76e69 946 }
TickTock 183:a1fba6f76e69 947 if (minTripEff>curEff) {
TickTock 183:a1fba6f76e69 948 minTripEff=curEff;
TickTock 183:a1fba6f76e69 949 minTripMiles=miles_trip[3];
TickTock 183:a1fba6f76e69 950 minTripkWh=kWh_trip[3];
TickTock 183:a1fba6f76e69 951 minTripCCkWh=CCkWh_trip[3];
TickTock 183:a1fba6f76e69 952 printMsg("New min efficiency.\n");
TickTock 183:a1fba6f76e69 953 }
TickTock 183:a1fba6f76e69 954 }
TickTock 183:a1fba6f76e69 955 // Clear daily efficiency data
TickTock 183:a1fba6f76e69 956 dailyGids=0;
TickTock 183:a1fba6f76e69 957 miles_trip[3]=0;
TickTock 183:a1fba6f76e69 958 kWh_trip[3]=0;
TickTock 183:a1fba6f76e69 959 CCkWh_trip[3]=0;
TickTock 183:a1fba6f76e69 960 ignoreDayData=false;
TickTock 183:a1fba6f76e69 961 lt=t; // Remember when counters were cleared (start time for new data)
TickTock 183:a1fba6f76e69 962 }
TickTock 183:a1fba6f76e69 963 } // Charged since last trip
TickTock 115:549410af477d 964 wait5secs=5;
TickTock 172:53548bf8bf85 965 if (showHealth&&!playbackOpen){
TickTock 175:0357b4159b40 966 if (saveDmode[0]==99){
TickTock 175:0357b4159b40 967 saveDmode[0]=dMode[0];
TickTock 134:ad243e4f1a17 968 }
TickTock 131:0d926c080a65 969 dMode[0]=healthScreen;
TickTock 131:0d926c080a65 970 }
TickTock 152:a4d66901785d 971 syncDone=!autoSync; // clear syncDone flag if autoSync enabled
TickTock 177:6fda79c2fda1 972 } // Car turned on
TickTock 49:a3d2c5bb3cfa 973 laccOn=accOn;
TickTock 135:89986950d501 974 if(!accOn&&userIdle&&!playbackEn){ // Car off and no user activity - turn off screen
TickTock 134:ad243e4f1a17 975 dled = 0;
TickTock 175:0357b4159b40 976 if (saveDmode[0]<99){
TickTock 175:0357b4159b40 977 dMode[0]=saveDmode[0];
TickTock 175:0357b4159b40 978 saveDmode[0]=99;
TickTock 175:0357b4159b40 979 }
TickTock 175:0357b4159b40 980 if (saveDmode[1]<99){
TickTock 175:0357b4159b40 981 dMode[1]=saveDmode[1];
TickTock 175:0357b4159b40 982 saveDmode[1]=99;
TickTock 134:ad243e4f1a17 983 }
TickTock 35:5acbd8a64a89 984 }else if(!headlights){
TickTock 35:5acbd8a64a89 985 dled = ledHi;
TickTock 115:549410af477d 986 } else {
TickTock 35:5acbd8a64a89 987 dled = ledLo;
TickTock 34:4751a8259b18 988 }
TickTock 178:bf6404312c45 989 cgids=(lastMsg[indexLastMsg[0x5bc]].data[0]<<2)+(lastMsg[indexLastMsg[0x5bc]].data[1]>>6);
TickTock 172:53548bf8bf85 990 if(getGids){
TickTock 178:bf6404312c45 991 startGids=cgids; //Get gids
TickTock 177:6fda79c2fda1 992 if((startGids>0)&&(startGids<300)){ // Ignore bogus values at startup
TickTock 172:53548bf8bf85 993 getGids=false;
TickTock 178:bf6404312c45 994 lgids=startGids; // initialize wh/gid array
TickTock 172:53548bf8bf85 995 }
TickTock 172:53548bf8bf85 996 }
TickTock 179:e4094e55f079 997 if((cgids>0)&&(cgids<300)){
TickTock 183:a1fba6f76e69 998 if(cgids!=lgids){
TickTock 184:5ca7b78297fe 999 if((kWh_trip[1]+CCkWh_trip[1])>0){
TickTock 184:5ca7b78297fe 1000 whpg[cgids] = (unsigned short) (1000*(kWh_trip[1]+CCkWh_trip[1])); // Save kWh for each gid since last charge
TickTock 184:5ca7b78297fe 1001 }else{
TickTock 184:5ca7b78297fe 1002 whpg[cgids] = 0;
TickTock 184:5ca7b78297fe 1003 }
TickTock 179:e4094e55f079 1004 lgids=cgids;
TickTock 179:e4094e55f079 1005 }
TickTock 178:bf6404312c45 1006 }
TickTock 115:549410af477d 1007 if(wait5secs>0){ // Wait a few seconds after poweron to give BMS time to measure CP's
TickTock 115:549410af477d 1008 wait5secs-=1;
TickTock 172:53548bf8bf85 1009 if(wait5secs==0){
TickTock 172:53548bf8bf85 1010 if (repeatPoll) { // Poll on startup if autopoll enabled
TickTock 172:53548bf8bf85 1011 logOnce=true;
TickTock 172:53548bf8bf85 1012 reqMsgCnt=0;
TickTock 172:53548bf8bf85 1013 msgReq.attach(&sendReq,0.015);
TickTock 172:53548bf8bf85 1014 lastDMode[0]=99;
TickTock 172:53548bf8bf85 1015 lastDMode[1]=99;
TickTock 172:53548bf8bf85 1016 }
TickTock 108:29b5a760adc2 1017 }
TickTock 107:e9be732c1ad4 1018 }
TickTock 173:9815b1467039 1019 //remove health screen once moving
TickTock 175:0357b4159b40 1020 if(moving&&(saveDmode[0]<99)&&(wait5secs==0)){
TickTock 175:0357b4159b40 1021 dMode[0]=saveDmode[0];
TickTock 175:0357b4159b40 1022 saveDmode[0]=99;
TickTock 173:9815b1467039 1023 }
TickTock 115:549410af477d 1024
TickTock 49:a3d2c5bb3cfa 1025 //compute historic efficiency
TickTock 41:8d4609ea7259 1026 if(numSsamples>0){ // Avoid div0
TickTock 160:905fe45ed54b 1027 // calibrated to dash mph which reads slightly fast.
TickTock 160:905fe45ed54b 1028 // 227 would give more accurate mph for MXV4s@40psi - 11.75" distance from center of tire to pavement
TickTock 160:905fe45ed54b 1029 // but then efficiency estimation would not track miles driven as read from the odometer so
TickTock 160:905fe45ed54b 1030 // making CANary have the same error as the Leaf instrumentation
TickTock 174:cd27e80f197d 1031 mph[0]=((float) motorRPM)/numSsamples/110;
TickTock 86:d1c9e8ac1c4b 1032 } else {
TickTock 49:a3d2c5bb3cfa 1033 mph[0]=0;
TickTock 36:dbd39c315258 1034 }
TickTock 49:a3d2c5bb3cfa 1035 if(mph[0]>99){
TickTock 49:a3d2c5bb3cfa 1036 mph[0]=0;
TickTock 49:a3d2c5bb3cfa 1037 }
TickTock 121:553faf139a20 1038 numSsamples=0;
TickTock 107:e9be732c1ad4 1039
TickTock 41:8d4609ea7259 1040 if(numWsamples>0){ // Avoid div0
TickTock 121:553faf139a20 1041 mpkWh[0]=mph[0];
TickTock 161:71ac85d11f03 1042 kW[0]=((float) mWs_x4)/numWsamples/4e3;
TickTock 49:a3d2c5bb3cfa 1043 mpkWh[0]/=kW[0];
TickTock 49:a3d2c5bb3cfa 1044 if (mpkWh[0]<0) {
TickTock 49:a3d2c5bb3cfa 1045 mpkWh[0]=99;// negative means inf.
TickTock 49:a3d2c5bb3cfa 1046 }
TickTock 161:71ac85d11f03 1047 kW[0]-=CCkW; // subtract climate control power from recorded value
TickTock 161:71ac85d11f03 1048 } else {
TickTock 49:a3d2c5bb3cfa 1049 kW[0]=0;
TickTock 49:a3d2c5bb3cfa 1050 mpkWh[0]=0;
TickTock 49:a3d2c5bb3cfa 1051 }
TickTock 121:553faf139a20 1052 numWsamples=0;
TickTock 121:553faf139a20 1053
TickTock 172:53548bf8bf85 1054 if(accOn&&!charging){ // Calculate averages
TickTock 161:71ac85d11f03 1055 for(i=1;i<39;i++){
TickTock 161:71ac85d11f03 1056 average=mph[i]/timeConstant[i];
TickTock 161:71ac85d11f03 1057 mph[i]-=average;
TickTock 161:71ac85d11f03 1058 mph[i]+=mph[0];
TickTock 161:71ac85d11f03 1059 mpkWh[i]=average;
TickTock 161:71ac85d11f03 1060 average=kW[i]/timeConstant[i];
TickTock 161:71ac85d11f03 1061 kW[i]-=average;
TickTock 161:71ac85d11f03 1062 kW[i]+=kW[0];
TickTock 162:c6545fc0164a 1063 if(i==dtePeriod) mpkWh_noCC=mpkWh[i]/average; // compute efficiency w/o CC for dtePeriod
TickTock 161:71ac85d11f03 1064 average+=CCkW; //add climate control power back in for display
TickTock 161:71ac85d11f03 1065 mpkWh[i]/=average;
TickTock 161:71ac85d11f03 1066 if (mpkWh[i]<0) {
TickTock 161:71ac85d11f03 1067 mpkWh[i]=99;// negative means inf.
TickTock 161:71ac85d11f03 1068 }
TickTock 161:71ac85d11f03 1069 }
TickTock 161:71ac85d11f03 1070 }
TickTock 161:71ac85d11f03 1071
TickTock 121:553faf139a20 1072 if (!charging){
TickTock 151:3047ebb3c9a8 1073 miles_trip[0]+=mph[0]/3600; // per trip
TickTock 151:3047ebb3c9a8 1074 miles_trip[1]+=mph[0]/3600; // per charge
TickTock 151:3047ebb3c9a8 1075 miles_trip[2]+=mph[0]/3600; // user
TickTock 179:e4094e55f079 1076 miles_trip[3]+=mph[0]/3600; // per day/roundtrip
TickTock 121:553faf139a20 1077 kWh_trip[0]+=kW[0]/3600;
TickTock 121:553faf139a20 1078 kWh_trip[1]+=kW[0]/3600;
TickTock 121:553faf139a20 1079 kWh_trip[2]+=kW[0]/3600;
TickTock 176:9c19f9856c76 1080 kWh_trip[3]+=kW[0]/3600;
TickTock 167:58d4edf403d4 1081 CCkWh_trip[0]+=CCkW/3600;
TickTock 167:58d4edf403d4 1082 CCkWh_trip[1]+=CCkW/3600;
TickTock 167:58d4edf403d4 1083 CCkWh_trip[2]+=CCkW/3600;
TickTock 176:9c19f9856c76 1084 CCkWh_trip[3]+=CCkW/3600;
TickTock 161:71ac85d11f03 1085 } else { // charging so reset per charge trip meter
TickTock 151:3047ebb3c9a8 1086 miles_trip[1]=0;
TickTock 151:3047ebb3c9a8 1087 kWh_trip[1]=0;
TickTock 167:58d4edf403d4 1088 CCkWh_trip[1]=0;
TickTock 121:553faf139a20 1089 }
TickTock 121:553faf139a20 1090
TickTock 174:cd27e80f197d 1091 motorRPM=0;
TickTock 40:0e6e71a7323f 1092 mWs_x4=0;
TickTock 121:553faf139a20 1093
TickTock 121:553faf139a20 1094 // Compute ESR
TickTock 121:553faf139a20 1095 if((Imax-Imin)<40){ // do nothing - insufficient delta_I to measure
TickTock 121:553faf139a20 1096 unloadedV_x2 = (curRmax+curRmin)/2;
TickTock 154:90ea16ca7475 1097 }else if ((redRmax-redRmin)<(curRmax-curRmin)) { // less variation on reduced Resr
TickTock 120:041edeec08f5 1098 Resr-=0.001;
TickTock 120:041edeec08f5 1099 unloadedV_x2 = (redRmax+redRmin)/2;
TickTock 154:90ea16ca7475 1100 } else if ((incRmax-incRmin)<(curRmax-curRmin)) { // less variation on increased Resr
TickTock 120:041edeec08f5 1101 Resr+=0.001;
TickTock 120:041edeec08f5 1102 unloadedV_x2 = (incRmax+incRmin)/2;
TickTock 154:90ea16ca7475 1103 } else { // current Resr is still best answer
TickTock 120:041edeec08f5 1104 unloadedV_x2 = (curRmax+curRmin)/2;
TickTock 120:041edeec08f5 1105 }
TickTock 120:041edeec08f5 1106 curRmin=1000;
TickTock 120:041edeec08f5 1107 curRmax=0;
TickTock 120:041edeec08f5 1108 incRmin=1000;
TickTock 120:041edeec08f5 1109 incRmax=0;
TickTock 120:041edeec08f5 1110 redRmin=1000;
TickTock 120:041edeec08f5 1111 redRmax=0;
TickTock 121:553faf139a20 1112 Imax=-1000;
TickTock 121:553faf139a20 1113 Imin=1000;
TickTock 121:553faf139a20 1114
TickTock 108:29b5a760adc2 1115 if(logCP&&usbEn){
TickTock 108:29b5a760adc2 1116 if(logOnce){
TickTock 108:29b5a760adc2 1117 tripLog();
TickTock 108:29b5a760adc2 1118 logOnce=false;
TickTock 108:29b5a760adc2 1119 }
garygid 69:6bfdfc002036 1120 logPackVoltages(); // Turbo3, only call
TickTock 108:29b5a760adc2 1121 }
TickTock 137:70853cf5a30f 1122 if(!usbEn){
TickTock 108:29b5a760adc2 1123 usbEn=detectUSB(); // Keep looking if none found
TickTock 132:08748a67280a 1124 if(usbEn){ // Force update to clear USB init garbage
TickTock 132:08748a67280a 1125 lastDMode[0]=99;
TickTock 132:08748a67280a 1126 lastDMode[1]=99;
TickTock 132:08748a67280a 1127 }
TickTock 108:29b5a760adc2 1128 }
TickTock 152:a4d66901785d 1129 if(!syncDone){
TickTock 153:e94cfe3c339c 1130 syncDone=syncDateTime();
TickTock 152:a4d66901785d 1131 }
TickTock 121:553faf139a20 1132 tock=true;
TickTock 121:553faf139a20 1133 } // tick
TickTock 39:eef8beac7411 1134
TickTock 36:dbd39c315258 1135 if(step){ // playback
TickTock 36:dbd39c315258 1136 if(playbackOpen&&playbackEn){
TickTock 38:155ec32c5e91 1137 for(i=0;i<120;i++){
TickTock 109:3e6f0e8fca0d 1138 if(!f_eof(&efile)){
TickTock 109:3e6f0e8fca0d 1139 efr=f_read(&efile,&header,5,&bytesRW);
TickTock 109:3e6f0e8fca0d 1140 efr=f_read(&efile,&data,8,&bytesRW);
garygid 69:6bfdfc002036 1141 logCan(header[0],CANMessage(0x7ff&((header[4]<<8)+header[3]), data, 8)); // Playback
TickTock 86:d1c9e8ac1c4b 1142 } else {
TickTock 109:3e6f0e8fca0d 1143 f_close(&efile); // restart
TickTock 109:3e6f0e8fca0d 1144 efr = f_open(&efile,"playback.alc",FA_READ|FA_OPEN_EXISTING);
TickTock 50:83d5864c64a0 1145 lastDMode[whichTouched]=99;//force refresh
TickTock 155:f31006516956 1146 beep(2000,0.25);
TickTock 36:dbd39c315258 1147 }
TickTock 36:dbd39c315258 1148 }
TickTock 36:dbd39c315258 1149 }
TickTock 36:dbd39c315258 1150 step=false;
TickTock 36:dbd39c315258 1151 }
TickTock 37:fea2c1d52c5f 1152
TickTock 140:ab3e94eb0227 1153 display=display<1?display+1:0; // toggle display
TickTock 140:ab3e94eb0227 1154 updateDisplay(display);
TickTock 2:71b1999a8ea5 1155 } //while (true)
TickTock 0:1596b8644523 1156 }