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 Aug 04 14:57:40 2013 +0000
Revision:
140:ab3e94eb0227
Parent:
139:ac227b203ef2
Child:
141:cf13a632ddb5
Added odometer to batt and trip log; Added mi/km detection from dash; Added audible brake monitor;

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 33:a277743ebdeb 4 // * Audible friction brake feedback
TickTock 33:a277743ebdeb 5 // * User-configurable watchpoint
TickTock 33:a277743ebdeb 6 // * Add 50% charge option
TickTock 102:fd19f777a0b4 7 // * Add coasting regen to regen/braking display
TickTock 103:1389e9efe8c3 8 // * Change semilog efficiency graph to linear with 10 minute values
TickTock 102:fd19f777a0b4 9 // * Add additional 79b bank readouts
TickTock 131:0d926c080a65 10 // * Subtract accessory power from efficiency history (add back in when displaying)
TickTock 135:89986950d501 11 // * Add trip history display
TickTock 13:62e0f7f39ff5 12
TickTock 140:ab3e94eb0227 13 // rev140
TickTock 140:ab3e94eb0227 14 // Added odometer to batt and trip log
TickTock 140:ab3e94eb0227 15 // Added mi/km detection from dash
TickTock 140:ab3e94eb0227 16 // Added audible brake monitor
TickTock 134:ad243e4f1a17 17
TickTock 12:8e42d7ba8468 18 #include "mbed.h"
TickTock 12:8e42d7ba8468 19 #include "CAN.h"
TickTock 12:8e42d7ba8468 20 #include "beep.h"
TickTock 109:3e6f0e8fca0d 21 #include "ff.h"
TickTock 12:8e42d7ba8468 22 #include "PowerControl.h"
TickTock 12:8e42d7ba8468 23 #include "EthernetPowerControl.h"
TickTock 12:8e42d7ba8468 24 #include "utility.h"
TickTock 12:8e42d7ba8468 25 #include "displayModes.h"
TickTock 23:cd03f9c3395e 26 #include "TOUCH_TFTx2.h"
TickTock 140:ab3e94eb0227 27 char revStr[7] = "140"; // gg - revision string, max 6 characters
TickTock 110:ffddff3ad2f2 28
TickTock 109:3e6f0e8fca0d 29 FATFS USBdrive;
TickTock 13:62e0f7f39ff5 30 LocalFileSystem local("local");
TickTock 115:549410af477d 31 unsigned char wait5secs = 5;
TickTock 13:62e0f7f39ff5 32 // to write to USB Flash Drives, or equivalent (SD card in Reader/Writer)
TickTock 119:0e2b641e98a2 33 // class10 SDcard in Reader/Writer recommended
TickTock 111:d1559bb25c43 34 FRESULT mfr = f_mount(0,&USBdrive);
TickTock 13:62e0f7f39ff5 35 time_t seconds ;
TickTock 13:62e0f7f39ff5 36
TickTock 36:dbd39c315258 37 Ticker autoPoll;
TickTock 36:dbd39c315258 38 Ticker playback;
TickTock 78:a383971fe02f 39 Ticker msgReq;
TickTock 140:ab3e94eb0227 40 Ticker geiger;
TickTock 13:62e0f7f39ff5 41 Timer timer;
TickTock 13:62e0f7f39ff5 42
TickTock 13:62e0f7f39ff5 43 DigitalOut led1(LED1);
TickTock 13:62e0f7f39ff5 44 DigitalOut led2(LED2);
TickTock 13:62e0f7f39ff5 45 DigitalOut led3(LED3);
TickTock 13:62e0f7f39ff5 46 DigitalOut led4(LED4);
TickTock 13:62e0f7f39ff5 47
TickTock 13:62e0f7f39ff5 48 InterruptIn touchpad(p17);
TickTock 13:62e0f7f39ff5 49 CAN can1(p9, p10); // CAN1 (EV) uses pins 9 and 10 (rx, tx) and pin 8 (rs)
TickTock 13:62e0f7f39ff5 50 DigitalOut can1SleepMode(p8); // Use pin 8 to control the sleep mode of can2
TickTock 13:62e0f7f39ff5 51 CAN can2(p30, p29); // CAN2 (CAR) uses pins 30 and 29 (rx, tx) and pin 28 (rs)
TickTock 13:62e0f7f39ff5 52 DigitalOut can2SleepMode(p28); // Use pin 28 to control the sleep mode of can1
TickTock 35:5acbd8a64a89 53 AnalogIn mon12V(p15);
TickTock 13:62e0f7f39ff5 54 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 55 PwmOut dled(p23);
TickTock 35:5acbd8a64a89 56 Beep spkr(p21);
TickTock 13:62e0f7f39ff5 57
garygid 87:46ac3f2519d6 58 bool debugMode = false;
TickTock 108:29b5a760adc2 59 bool usbEn = false;
TickTock 131:0d926c080a65 60 bool logEn = false;
TickTock 108:29b5a760adc2 61 bool logOpen = false;
TickTock 115:549410af477d 62 bool yesBattLog = true; // gg - Batt Log
TickTock 108:29b5a760adc2 63 unsigned char tNavRow = 3; // gg - 4x4 touch
TickTock 140:ab3e94eb0227 64 bool brakeMon = false; // disable until desired value read from config
TickTock 140:ab3e94eb0227 65 unsigned char bp;
garygid 54:6ce808d0995e 66
TickTock 109:3e6f0e8fca0d 67 FILE *hfile; // history file
TickTock 109:3e6f0e8fca0d 68 FIL efile; // external usb file
TickTock 109:3e6f0e8fca0d 69 FRESULT efr; // external file access flags
TickTock 109:3e6f0e8fca0d 70 unsigned int bytesRW;
TickTock 108:29b5a760adc2 71 char fileName[35] = "";
TickTock 84:fd21e5d32dab 72 char writeBuffer[maxBufLen][13] __attribute__ ((section("AHBSRAM1"))); // buffer for USB write
TickTock 13:62e0f7f39ff5 73 char indexLastMsg[0x800]={0}; // index table for last message
TickTock 13:62e0f7f39ff5 74 CANMessage lastMsg[100]; // table to store last message of eachtype
garygid 87:46ac3f2519d6 75
TickTock 124:0d622967b764 76 unsigned char battData[BatDataBufMax]={0}; // 7 * 0x3D = BatDataBufMax
garygid 87:46ac3f2519d6 77
TickTock 13:62e0f7f39ff5 78 unsigned char msgChanged[100]; // inidcates which bytes changed
TickTock 13:62e0f7f39ff5 79 char c;
TickTock 76:fb6779d0963e 80 volatile int writePointer = 0;
TickTock 76:fb6779d0963e 81 int readPointer=0;
TickTock 131:0d926c080a65 82 volatile unsigned short secsNoCarCanMsg = 0;
TickTock 132:08748a67280a 83 volatile unsigned short secsNoEvCanMsg = 0;
TickTock 75:77bd26829dca 84 volatile unsigned short secsNoTouch = 0;
TickTock 132:08748a67280a 85 volatile bool carCanIdle,evCanIdle,userIdle;
TickTock 26:462ccb580472 86 bool touched=false; //flag to read touchscreen
TickTock 42:4533b13b297d 87 unsigned char whichTouched = 0;
TickTock 13:62e0f7f39ff5 88 char counter = 0;
TickTock 41:8d4609ea7259 89 unsigned char dMode[2] = {mainScreen,brakeScreen}; //display mode
TickTock 13:62e0f7f39ff5 90 unsigned char sMode = 0; // setup mode
TickTock 13:62e0f7f39ff5 91 unsigned char lastDMode[2] = {0,0}; //last screen mode
TickTock 131:0d926c080a65 92 unsigned char dtMode = 0;
TickTock 13:62e0f7f39ff5 93 char displayLog[20][40];
TickTock 13:62e0f7f39ff5 94 unsigned char displayLoc = 0;
leafman 98:9f8bab96edff 95 unsigned int fwCount=1;
TickTock 13:62e0f7f39ff5 96 unsigned char indexOffset = 1;
TickTock 13:62e0f7f39ff5 97 bool showCP = false;
TickTock 39:eef8beac7411 98 bool logCP = false; //Turbo3
TickTock 108:29b5a760adc2 99 bool logOnce = false;
TickTock 103:1389e9efe8c3 100 bool repeatPoll = true;
TickTock 34:4751a8259b18 101 bool headlights = false;
TickTock 140:ab3e94eb0227 102 bool miles_kmbar = true;
TickTock 34:4751a8259b18 103 bool tick = false;
garygid 69:6bfdfc002036 104 bool ZeroSecTick = false;
TickTock 35:5acbd8a64a89 105 float ledHi = 0.8; // Bright LED value (until config file read)
TickTock 35:5acbd8a64a89 106 float ledLo = 0.1; // Dim LED value (until config file read)
TickTock 35:5acbd8a64a89 107 unsigned short pollInt = 300; // polling interval=5 minutes (until config file read)
TickTock 35:5acbd8a64a89 108 bool accOn = false; // Accessories on
TickTock 49:a3d2c5bb3cfa 109 bool laccOn = false;
TickTock 35:5acbd8a64a89 110 float scale12V = 16.2; // R1:R2 ratio
TickTock 40:0e6e71a7323f 111 signed long mWs_x4 = 0;
TickTock 40:0e6e71a7323f 112 unsigned short numWsamples = 0;
TickTock 41:8d4609ea7259 113 unsigned short numSsamples = 0;
TickTock 35:5acbd8a64a89 114 float accV = 0;
TickTock 36:dbd39c315258 115 bool playbackEn = false;
TickTock 36:dbd39c315258 116 bool playbackOpen = false;
TickTock 49:a3d2c5bb3cfa 117 //float playbackInt = 0.05; //read messages every 50 ms
TickTock 78:a383971fe02f 118 float playbackInt = 0.005; //read messages every 5 ms
TickTock 36:dbd39c315258 119 bool step = false;
TickTock 37:fea2c1d52c5f 120 char header[5];
TickTock 36:dbd39c315258 121 char data[8];
TickTock 41:8d4609ea7259 122 signed long motorRPM;
garygid 65:821fc79cd7fe 123 unsigned char skin = ttSkin ;
TickTock 50:83d5864c64a0 124 unsigned char dtePeriod = 14; //ten minute averaging interval
TickTock 107:e9be732c1ad4 125 float kWh_trip[3]={0};
TickTock 107:e9be732c1ad4 126 float miles_trip[3]={0};
TickTock 134:ad243e4f1a17 127 float maxTripEff = 4;
TickTock 134:ad243e4f1a17 128 float minTripEff = 4;
TickTock 49:a3d2c5bb3cfa 129 float mph[39]={0};
TickTock 49:a3d2c5bb3cfa 130 float kW[39]={0};
TickTock 49:a3d2c5bb3cfa 131 float mpkWh[39]={0};
TickTock 120:041edeec08f5 132 float unloadedV_x2,Resr,curRmax,curRmin,redRmax,redRmin,incRmax,incRmin;
TickTock 121:553faf139a20 133 signed short Imax, Imin;
TickTock 49:a3d2c5bb3cfa 134 // Logarithmic division scale (roughly - snapped to common units of time)
TickTock 49:a3d2c5bb3cfa 135 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 136 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 137 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 138 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 139 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 140 bool tock = false;
TickTock 73:62ee8eae3a84 141 unsigned short pointerSep;
TickTock 78:a383971fe02f 142 unsigned char reqMsgCnt = 99;
TickTock 102:fd19f777a0b4 143 unsigned long Ah_x10000 = 0;
TickTock 102:fd19f777a0b4 144 unsigned long SOC_x10000 = 0;
TickTock 102:fd19f777a0b4 145 unsigned short SOH_x100 = 0;
TickTock 108:29b5a760adc2 146 float maxTemp = 0;
leafman 98:9f8bab96edff 147 bool metric = false;
TickTock 121:553faf139a20 148 bool shunt[96]={0};
TickTock 121:553faf139a20 149 bool charging=false;
TickTock 131:0d926c080a65 150 bool showHealth=false;
TickTock 131:0d926c080a65 151 unsigned char saveDmode=99;
TickTock 131:0d926c080a65 152 bool moving=false;
TickTock 140:ab3e94eb0227 153 unsigned short chirpInt;
TickTock 13:62e0f7f39ff5 154
TickTock 0:1596b8644523 155 int main() {
TickTock 4:8d7759f4fe7a 156 char sTemp[40];
TickTock 2:71b1999a8ea5 157 unsigned long secs;
TickTock 49:a3d2c5bb3cfa 158 unsigned char i,j,display=0,lwt=0;
TickTock 22:a43df3905863 159 point lastTouch;
TickTock 52:d5385fbf4ea1 160 float average;
TickTock 3:3e879b043bc5 161 tt.set_orientation(1);
TickTock 4:8d7759f4fe7a 162 tt.background(Black);
TickTock 19:d576298c46f3 163 tt.set_display(2); // select both displays
TickTock 3:3e879b043bc5 164 tt.cls();
TickTock 137:70853cf5a30f 165 tt.foreground(White);
TickTock 137:70853cf5a30f 166 tt.set_font((unsigned char*) Arial12x12_prop); // select the font
TickTock 137:70853cf5a30f 167 tt.locate(0,0);
TickTock 1:9dcd70c32180 168 tt.claim(stdout); // send stdout to the TFT display
TickTock 137:70853cf5a30f 169 if(tt.is_touched()){ // If touching screen on poweron then update firmware
TickTock 137:70853cf5a30f 170 updateFirmware();
TickTock 137:70853cf5a30f 171 }
TickTock 12:8e42d7ba8468 172 touchpad.rise(&touch_ISR);
TickTock 4:8d7759f4fe7a 173 tt.wfi(); // enable interrupt on touch
TickTock 7:17bf9ceaf0aa 174 dled = 0.8; // turn on display LED 80%
TickTock 120:041edeec08f5 175 Resr = 0.075; // initial guess of Resr
TickTock 2:71b1999a8ea5 176 timer.start() ;
TickTock 2:71b1999a8ea5 177 RTC_Init(); // start the RTC Interrupts that sync the timer
TickTock 1:9dcd70c32180 178 struct tm t; // pointer to a static tm structure
TickTock 93:c2402e8cd0e2 179 NVIC_SetPriority(CAN_IRQn, 2); //set can priority just below RTC
TickTock 117:49883c779a74 180 NVIC_SetPriority(TIMER3_IRQn, 3); //set ticker priority just below can
TickTock 33:a277743ebdeb 181
TickTock 1:9dcd70c32180 182 seconds = time(NULL);
TickTock 1:9dcd70c32180 183 t = *localtime(&seconds) ;
TickTock 1:9dcd70c32180 184 // is it a date before 2012 ?
TickTock 26:462ccb580472 185 if ((t.tm_year + 1900) < 2012 ) {
TickTock 26:462ccb580472 186 // before 2013 so update year to make date entry easier
TickTock 26:462ccb580472 187 t.tm_year = 2013 - 1900;
TickTock 1:9dcd70c32180 188 // set the RTC
TickTock 1:9dcd70c32180 189 set_time(mktime(&t));
TickTock 1:9dcd70c32180 190 seconds = time(NULL);
TickTock 26:462ccb580472 191 }
TickTock 20:3bf176d14b14 192 t = *localtime(&seconds) ;
TickTock 20:3bf176d14b14 193 strftime(sTemp, 32, "%a %m/%d/%Y %X\n", &t);
TickTock 93:c2402e8cd0e2 194 printMsg(sTemp); // record RTC
garygid 54:6ce808d0995e 195
TickTock 62:ffd15edb5431 196 // revision
garygid 70:0700b769ac15 197 sprintf(sTemp,"CANary firmware rev%s\n", revStr); // gg - for Logging the revision
TickTock 93:c2402e8cd0e2 198 printMsg(sTemp); // revision
TickTock 17:e32324a2678d 199
TickTock 131:0d926c080a65 200 secsNoCarCanMsg = 0;
TickTock 132:08748a67280a 201 secsNoEvCanMsg = 0;
TickTock 43:e7f6f80590e3 202
TickTock 49:a3d2c5bb3cfa 203 //read efficiency history data
TickTock 97:a25940fd7b5b 204 hfile = fopen("/local/ehist.cny", "r");
TickTock 97:a25940fd7b5b 205 if (hfile!=NULL){ // found a efficiency history file
TickTock 49:a3d2c5bb3cfa 206 for(i=0;i<39;i++){
TickTock 97:a25940fd7b5b 207 if(!feof(hfile)){
TickTock 97:a25940fd7b5b 208 fscanf(hfile,"%f %f\r\n",&mph[i],&kW[i]);
TickTock 49:a3d2c5bb3cfa 209 mpkWh[i]=mph[i]/kW[i];
TickTock 49:a3d2c5bb3cfa 210 }
TickTock 49:a3d2c5bb3cfa 211 }
TickTock 134:ad243e4f1a17 212 if(!feof(hfile)){
TickTock 134:ad243e4f1a17 213 fscanf(hfile,"%f %f\r\n",&maxTripEff,&minTripEff);
TickTock 134:ad243e4f1a17 214 }
TickTock 97:a25940fd7b5b 215 fclose(hfile);
TickTock 116:5cd72bae7c12 216 printMsg("History Loaded.\n"); // History loaded
TickTock 49:a3d2c5bb3cfa 217 } else { // create initial file
TickTock 116:5cd72bae7c12 218 printMsg("History not found. Created.\n"); // history not found, created
TickTock 49:a3d2c5bb3cfa 219 for(i=0;i<39;i++){
TickTock 49:a3d2c5bb3cfa 220 // Pre-load with 4 mpkWh @ 40 mph
TickTock 49:a3d2c5bb3cfa 221 mph[i]=40*timeConstant[i];
TickTock 49:a3d2c5bb3cfa 222 kW[i]=10*timeConstant[i];
TickTock 49:a3d2c5bb3cfa 223 mpkWh[i]=4;
TickTock 49:a3d2c5bb3cfa 224 }
TickTock 49:a3d2c5bb3cfa 225 }
TickTock 49:a3d2c5bb3cfa 226
TickTock 46:73e8716f976f 227 // Read config file
TickTock 46:73e8716f976f 228 readConfig();
TickTock 140:ab3e94eb0227 229 if (brakeMon){
TickTock 140:ab3e94eb0227 230 geiger.attach(&chirp,0.02);
TickTock 140:ab3e94eb0227 231 }
TickTock 108:29b5a760adc2 232 if (repeatPoll) { // enable autopolling if enabled
TickTock 108:29b5a760adc2 233 autoPoll.attach(&autoPollISR,pollInt);
TickTock 108:29b5a760adc2 234 }
TickTock 108:29b5a760adc2 235
TickTock 77:7c136766466c 236 // Start monitors
TickTock 77:7c136766466c 237 can1.monitor(true); // set to snoop mode
TickTock 77:7c136766466c 238 can2.monitor(true); // set to snoop mode
TickTock 77:7c136766466c 239 can1.frequency(500000);
TickTock 77:7c136766466c 240 can2.frequency(500000);
TickTock 120:041edeec08f5 241 can1SleepMode = VP230Sleep; // Turn on Monitor_only Mode
TickTock 120:041edeec08f5 242 can2SleepMode = VP230Sleep; // Turn on Monitor_only Mode
TickTock 77:7c136766466c 243 can1.attach(&recieve1);
TickTock 77:7c136766466c 244 can2.attach(&recieve2);
TickTock 77:7c136766466c 245
TickTock 26:462ccb580472 246 touched=false;
TickTock 26:462ccb580472 247 secsNoTouch=2;
TickTock 2:71b1999a8ea5 248 while (true) {
TickTock 4:8d7759f4fe7a 249 if (!logOpen) { // Open new file if one is not already open
TickTock 131:0d926c080a65 250 if(logEn&&usbEn){ //logging enabled and USB device detected
TickTock 109:3e6f0e8fca0d 251 strftime(fileName, 32, "%m%d%H%M.alc", &t); //mmddhhmm.alc
TickTock 109:3e6f0e8fca0d 252 efr = f_open(&efile,fileName,FA_WRITE|FA_OPEN_ALWAYS);
TickTock 7:17bf9ceaf0aa 253 seconds = time(NULL);
TickTock 7:17bf9ceaf0aa 254 t = *localtime(&seconds) ;
TickTock 94:c3a14b3975d6 255 lastDMode[0]=99;//force refresh
TickTock 94:c3a14b3975d6 256 lastDMode[1]=99;//force refresh
TickTock 109:3e6f0e8fca0d 257 if(efr != FR_OK){
TickTock 109:3e6f0e8fca0d 258 sprintf(sTemp,"\nERR:%d Unable to open %s\n\n\n\n",efr,fileName);
TickTock 93:c2402e8cd0e2 259 printMsg(sTemp); // cannot open alc file
TickTock 7:17bf9ceaf0aa 260 logEn=false;
TickTock 26:462ccb580472 261 spkr.beep(1000,0.25);
TickTock 109:3e6f0e8fca0d 262 wait_ms(500);
TickTock 109:3e6f0e8fca0d 263 spkr.beep(1000,0.25);
TickTock 7:17bf9ceaf0aa 264 } else {
TickTock 7:17bf9ceaf0aa 265 logOpen = true;
TickTock 7:17bf9ceaf0aa 266 readPointer=writePointer;
TickTock 7:17bf9ceaf0aa 267 sprintf(sTemp,"Starting Can Log %s\n",fileName);
TickTock 93:c2402e8cd0e2 268 printMsg(sTemp); // starting alc log file
garygid 69:6bfdfc002036 269
garygid 69:6bfdfc002036 270 logTS(); // Date Time at start
TickTock 93:c2402e8cd0e2 271 logEvent("Starting"); // Log startup msg for testing
garygid 69:6bfdfc002036 272 sprintf(sTemp,"Cr%s",revStr);
TickTock 108:29b5a760adc2 273 logEvent(sTemp); // gg - log firmware version
TickTock 26:462ccb580472 274 spkr.beep(2000,0.25);
TickTock 7:17bf9ceaf0aa 275 }
TickTock 108:29b5a760adc2 276 }//logging enabled and USB detected
TickTock 15:a359fecf85ba 277 } else { // if (logOpen)
TickTock 73:62ee8eae3a84 278 pointerSep=(writePointer+maxBufLen-readPointer)%maxBufLen;
TickTock 131:0d926c080a65 279 if (pointerSep>(maxBufLen/16)||carCanIdle||!logEn) {
TickTock 7:17bf9ceaf0aa 280 // Dump buffer if > 1/16 full or canbus has stopped
TickTock 117:49883c779a74 281 if (efr != FR_OK) {
TickTock 7:17bf9ceaf0aa 282 logOpen = false;
TickTock 117:49883c779a74 283 printMsg("Failed to append log file.\n"); // failed to append
TickTock 117:49883c779a74 284 spkr.beep(3000,0.25);
TickTock 117:49883c779a74 285 spkr.beep(1500,0.25);
TickTock 117:49883c779a74 286 spkr.beep(750,0.25);
TickTock 117:49883c779a74 287 spkr.beep(375,0.25);
TickTock 7:17bf9ceaf0aa 288 logEn=false;
TickTock 7:17bf9ceaf0aa 289 } else {
TickTock 7:17bf9ceaf0aa 290 while (readPointer != writePointer) {
TickTock 117:49883c779a74 291 efr=f_write(&efile,&writeBuffer[readPointer][0],13,&bytesRW);
TickTock 117:49883c779a74 292 if(++readPointer >= maxBufLen){
TickTock 117:49883c779a74 293 readPointer=0;
TickTock 117:49883c779a74 294 led4 = !led4;
TickTock 4:8d7759f4fe7a 295 }
TickTock 4:8d7759f4fe7a 296 }
TickTock 7:17bf9ceaf0aa 297 }
TickTock 30:e633a63eb257 298 } // if > 1/16 full, canbus has stopped, or logging stopped
TickTock 30:e633a63eb257 299 if (!logEn) {
TickTock 77:7c136766466c 300 sprintf(sTemp,"Stopping Can Log %s\n",fileName);
TickTock 93:c2402e8cd0e2 301 printMsg(sTemp); // stopping alc log file
TickTock 109:3e6f0e8fca0d 302 f_close(&efile);
TickTock 30:e633a63eb257 303 logOpen=false;
TickTock 77:7c136766466c 304 pointerSep=0;
TickTock 108:29b5a760adc2 305 led4=false;
TickTock 30:e633a63eb257 306 }
TickTock 4:8d7759f4fe7a 307 } // if logOpen
TickTock 132:08748a67280a 308 if (carCanIdle && (evCanIdle || !logOpen) && userIdle && !playbackEn) { // canbus idle --> sleep to save power
TickTock 95:248b3c25a7df 309 if (repeatPoll) { // stop autopolling if enabled
TickTock 95:248b3c25a7df 310 autoPoll.detach();
TickTock 95:248b3c25a7df 311 }
TickTock 111:d1559bb25c43 312 if (logOpen){ //close file to dump buffer
TickTock 111:d1559bb25c43 313 f_close(&efile);
TickTock 134:ad243e4f1a17 314 } else { //detach EVcan so only carcan will trigger wake
TickTock 134:ad243e4f1a17 315 can1.attach(NULL);
TickTock 134:ad243e4f1a17 316 }// if (logOpen)
TickTock 20:3bf176d14b14 317 seconds = time(NULL);
TickTock 20:3bf176d14b14 318 t = *localtime(&seconds) ;
TickTock 21:22bdce9efcb5 319 strftime(sTemp, 40, "Sleeping: %a %m/%d/%Y %X\n", &t);
TickTock 93:c2402e8cd0e2 320 printMsg(sTemp); // sleeping date time
TickTock 25:ddf0ec209f03 321 updateDisplay(0); //Added for turbo3 who has a display override and wants to see the sleep message before going to sleep
TickTock 25:ddf0ec209f03 322 updateDisplay(1);
TickTock 4:8d7759f4fe7a 323 //LPC_RTC->CIIR=0x00; // block RTC interrupts
TickTock 4:8d7759f4fe7a 324 led1=0;
TickTock 4:8d7759f4fe7a 325 led2=0;
TickTock 4:8d7759f4fe7a 326 led3=0;
TickTock 4:8d7759f4fe7a 327 led4=0;
TickTock 4:8d7759f4fe7a 328 dled=0; // turn off display
TickTock 4:8d7759f4fe7a 329 secs = time(NULL); // seconds past 12:00:00 AM 1 Jan 1900
TickTock 132:08748a67280a 330 while (secsNoCarCanMsg>canTimeout && (secsNoEvCanMsg>canTimeout || !logOpen) && !touched) {
TickTock 4:8d7759f4fe7a 331 //DeepPowerDown();
TickTock 12:8e42d7ba8468 332 tt.wfi(); //enable touch interrupt
TickTock 21:22bdce9efcb5 333 //__wfi(); // freeze CPU and wait for interrupt (from canbus or touch)
TickTock 21:22bdce9efcb5 334 Sleep();
TickTock 4:8d7759f4fe7a 335 }
TickTock 135:89986950d501 336 if (!logOpen){ // Re-attach EVcan
TickTock 134:ad243e4f1a17 337 can1.attach(&recieve1);
TickTock 134:ad243e4f1a17 338 }
TickTock 43:e7f6f80590e3 339 secsNoTouch=2;
TickTock 131:0d926c080a65 340 carCanIdle=secsNoCarCanMsg>canTimeout;
TickTock 132:08748a67280a 341 evCanIdle=secsNoEvCanMsg>canTimeout;
TickTock 7:17bf9ceaf0aa 342 dled=0.8; // turn on display LED
TickTock 20:3bf176d14b14 343 seconds = time(NULL);
TickTock 20:3bf176d14b14 344 t = *localtime(&seconds) ;
TickTock 21:22bdce9efcb5 345 strftime(sTemp, 40, "Waking: %a %m/%d/%Y %X\n", &t);
TickTock 93:c2402e8cd0e2 346 printMsg(sTemp); // wakeup date time
TickTock 4:8d7759f4fe7a 347 if (time(NULL)>(secs+1800)) {
TickTock 110:ffddff3ad2f2 348 if (logOpen){
TickTock 110:ffddff3ad2f2 349 f_close(&efile);
TickTock 110:ffddff3ad2f2 350 logOpen = false; // Start new file if asleep for more than 30 minutes
TickTock 110:ffddff3ad2f2 351 } // if (logOpen)
TickTock 4:8d7759f4fe7a 352 if (secsNoTouch>100) secsNoTouch = 100; // also mostly reset user Idle counter
TickTock 43:e7f6f80590e3 353 } else if (logOpen){ // insert timestamp on each wake if logging enabled (disabled for now)
TickTock 111:d1559bb25c43 354 efr = f_open(&efile,fileName,FA_WRITE|FA_OPEN_ALWAYS);
TickTock 111:d1559bb25c43 355 f_lseek(&efile,0xffffffff); // goto end of file (append existing)
TickTock 93:c2402e8cd0e2 356 logEvent("WakingUp"); // gg - use messeges
garygid 69:6bfdfc002036 357 logTS(); // Date-Time at wakeup
TickTock 4:8d7759f4fe7a 358 }
TickTock 95:248b3c25a7df 359 if (repeatPoll) { // re-enable autopolling if enabled
TickTock 124:0d622967b764 360 autoPoll.attach(&autoPollISR,pollInt);
TickTock 95:248b3c25a7df 361 }
TickTock 136:41a204105511 362 wait5secs=5; // Refresh screen after 5 seconds
TickTock 4:8d7759f4fe7a 363 } // if idle
TickTock 4:8d7759f4fe7a 364
TickTock 15:a359fecf85ba 365 if(touched){ // call touchscreen procedure if touch interrupt detected
TickTock 7:17bf9ceaf0aa 366 lastTouch = tt.get_touch();
TickTock 7:17bf9ceaf0aa 367 lastTouch = tt.to_pixel(lastTouch); // convert to pixel pos
TickTock 40:0e6e71a7323f 368 if((lastTouch.x!=639)&&(lastTouch.x!=319)&&(lastTouch.y!=239)){ // filter phantom touches
TickTock 43:e7f6f80590e3 369 if (userIdle) {
TickTock 43:e7f6f80590e3 370 secsNoTouch=2; // Ignore first touch if user idle
TickTock 43:e7f6f80590e3 371 userIdle=false;
TickTock 40:0e6e71a7323f 372 } else {
TickTock 43:e7f6f80590e3 373 secsNoTouch=0;
TickTock 40:0e6e71a7323f 374 }
TickTock 43:e7f6f80590e3 375 if (lastTouch.x>320){
TickTock 43:e7f6f80590e3 376 whichTouched=1;
TickTock 43:e7f6f80590e3 377 } else {
TickTock 43:e7f6f80590e3 378 whichTouched=0;
TickTock 43:e7f6f80590e3 379 }
TickTock 43:e7f6f80590e3 380 if (whichTouched!=lwt){
TickTock 43:e7f6f80590e3 381 lastDMode[lwt]=99; // Repaint lastTouched
TickTock 43:e7f6f80590e3 382 lwt=whichTouched;
TickTock 43:e7f6f80590e3 383 }
TickTock 43:e7f6f80590e3 384 sMode = 1;
TickTock 22:a43df3905863 385 }
TickTock 22:a43df3905863 386 //sprintf(sTemp,"%d,%d ",lastTouch.x,lastTouch.y);
TickTock 93:c2402e8cd0e2 387 //printMsg(sTemp); // touch x,y - for debug
TickTock 12:8e42d7ba8468 388 touched = false; // clear interrupt flag
TickTock 7:17bf9ceaf0aa 389 }
garygid 54:6ce808d0995e 390 //---------------
garygid 54:6ce808d0995e 391 // gg - 4x4 touch
TickTock 62:ffd15edb5431 392 //unsigned char tScrn = 0 ; // screen 0
garygid 54:6ce808d0995e 393 unsigned char tCol ;
garygid 54:6ce808d0995e 394 unsigned char tRow ;
garygid 54:6ce808d0995e 395
TickTock 4:8d7759f4fe7a 396 if (!userIdle) {
TickTock 4:8d7759f4fe7a 397 if (secsNoTouch<2) {// Recently touched
TickTock 4:8d7759f4fe7a 398 secsNoTouch +=2; // increment to prevent double touch
TickTock 43:e7f6f80590e3 399 sMode = 1;
TickTock 22:a43df3905863 400 //sprintf(sTemp,"button %d %d,%d %d\n",i,buttonX(lastTouch.x,3),buttonY(lastTouch.y,3),lastTouch.x);
TickTock 93:c2402e8cd0e2 401 //printMsg(sTemp); // button parms - for debug
TickTock 23:cd03f9c3395e 402 switch (sMode) {
TickTock 23:cd03f9c3395e 403 case 0: // no select
TickTock 23:cd03f9c3395e 404 break;
TickTock 63:aa3bf6a33635 405 case 1: // select screen
garygid 54:6ce808d0995e 406 //--------------
garygid 54:6ce808d0995e 407 // gg - 4x4 touch
garygid 54:6ce808d0995e 408 tCol = buttonX(lastTouch.x,4) ;
TickTock 62:ffd15edb5431 409 if( tCol >= 4 ){ tCol -= 4; } // touch is on screen 1
garygid 54:6ce808d0995e 410
garygid 54:6ce808d0995e 411 tRow = buttonY(lastTouch.y,4) ;
garygid 54:6ce808d0995e 412
TickTock 63:aa3bf6a33635 413 highlightButton( tCol,tRow, whichTouched, 4,4) ; // gg - highlight
garygid 58:4d06288d75a2 414
TickTock 63:aa3bf6a33635 415 if( tRow == tNavRow ) tRow = 7 ; // gg
garygid 54:6ce808d0995e 416 switch ( (tCol*10) + tRow ) {
garygid 54:6ce808d0995e 417 //---------------------------------
garygid 67:2022fce701d0 418 case 00: // top row, left button on screen 0 or 1
TickTock 42:4533b13b297d 419 if (dMode[whichTouched]==monitorScreen||dMode[whichTouched]==changedScreen) {
garygid 67:2022fce701d0 420 indexOffset=indexOffset>4?indexOffset-4:1;
garygid 67:2022fce701d0 421 } else if (dMode[whichTouched] == indexScreen) { // gg - index
garygid 67:2022fce701d0 422 dMode[whichTouched] = mainScreen ; // GoTo Main Screen
TickTock 73:62ee8eae3a84 423 sMode=0;
leafman 98:9f8bab96edff 424 } else if (dMode[whichTouched]==configScreen) {
TickTock 23:cd03f9c3395e 425 wait_ms(500);
TickTock 37:fea2c1d52c5f 426 tt.background(Black);
TickTock 23:cd03f9c3395e 427 tt.calibrate();
TickTock 42:4533b13b297d 428 } else if (dMode[whichTouched]==playbackScreen) { // slower
TickTock 36:dbd39c315258 429 playbackInt *=2;
TickTock 36:dbd39c315258 430 if(playbackEn){
TickTock 36:dbd39c315258 431 playback.detach();
TickTock 36:dbd39c315258 432 playback.attach(&playbackISR,playbackInt);
TickTock 36:dbd39c315258 433 }
TickTock 62:ffd15edb5431 434 } else {
TickTock 62:ffd15edb5431 435 lastDMode[whichTouched]=99;//repaint to clear highlight
TickTock 23:cd03f9c3395e 436 }
TickTock 23:cd03f9c3395e 437 break;
garygid 54:6ce808d0995e 438 //-----------------------------------------------
garygid 67:2022fce701d0 439 case 10: // 1,0 (col left of center,top row) on screen 0 or 1
TickTock 42:4533b13b297d 440 if (dMode[whichTouched]==changedScreen) {
TickTock 23:cd03f9c3395e 441 for(j=0;j<100;j++) msgChanged[j]=0; // clear changed data
TickTock 42:4533b13b297d 442 lastDMode[whichTouched]=99;//force refresh
garygid 67:2022fce701d0 443 } else if (dMode[whichTouched] == indexScreen) { // gg - index
TickTock 73:62ee8eae3a84 444 sMode=0;
garygid 67:2022fce701d0 445 dMode[whichTouched] = brakeScreen ; // GoTo Brake Screen
TickTock 42:4533b13b297d 446 } else if (dMode[whichTouched]==cpScreen) {
TickTock 78:a383971fe02f 447 reqMsgCnt=0;
TickTock 79:68f0dd8d1f19 448 msgReq.attach(&sendReq,0.015);
TickTock 48:d1ce92104a1f 449 } else if (dMode[whichTouched]==cpHistScreen) { // gg - hist
TickTock 78:a383971fe02f 450 reqMsgCnt=0;
TickTock 79:68f0dd8d1f19 451 msgReq.attach(&sendReq,0.015);
TickTock 48:d1ce92104a1f 452 } else if (dMode[whichTouched]==cpBarScreen) { // gg - cpbars
TickTock 78:a383971fe02f 453 reqMsgCnt=0;
TickTock 79:68f0dd8d1f19 454 msgReq.attach(&sendReq,0.015);
leafman 98:9f8bab96edff 455 } else if (dMode[whichTouched]==configScreen) {
TickTock 23:cd03f9c3395e 456 mbed_reset();
TickTock 42:4533b13b297d 457 } else if (dMode[whichTouched]==playbackScreen) { // pause/unpause
TickTock 36:dbd39c315258 458 playbackEn=!playbackEn;
TickTock 36:dbd39c315258 459 if(playbackEn){
TickTock 36:dbd39c315258 460 playback.attach(&playbackISR,playbackInt);
TickTock 62:ffd15edb5431 461 } else {
TickTock 36:dbd39c315258 462 playback.detach();
TickTock 36:dbd39c315258 463 }
TickTock 62:ffd15edb5431 464 } else {
TickTock 62:ffd15edb5431 465 lastDMode[whichTouched]=99;//repaint to clear highlight
TickTock 23:cd03f9c3395e 466 }
TickTock 62:ffd15edb5431 467
TickTock 23:cd03f9c3395e 468 break;
garygid 54:6ce808d0995e 469 //--------------------------------------
garygid 54:6ce808d0995e 470 case 20: // col 2 and row 0 on either screen 0 or 1
TickTock 42:4533b13b297d 471 if (dMode[whichTouched]==monitorScreen||dMode[whichTouched]==changedScreen) {
TickTock 23:cd03f9c3395e 472 indexOffset=indexOffset<77?indexOffset+4:80;
garygid 67:2022fce701d0 473 } else if (dMode[whichTouched] == indexScreen) { // gg - index
garygid 67:2022fce701d0 474 dMode[whichTouched] = effScreen ; // GoTo EFF Screen
TickTock 73:62ee8eae3a84 475 sMode=0;
leafman 98:9f8bab96edff 476 } else if (dMode[whichTouched]==configScreen) {
TickTock 116:5cd72bae7c12 477 printMsg("Saving config file.\n"); // saving config
TickTock 25:ddf0ec209f03 478 saveConfig();
TickTock 26:462ccb580472 479 spkr.beep(2000,0.25);
TickTock 42:4533b13b297d 480 } else if (dMode[whichTouched]==playbackScreen) { // faster
TickTock 36:dbd39c315258 481 if(playbackInt>.002){
TickTock 36:dbd39c315258 482 playbackInt/=2;
TickTock 36:dbd39c315258 483 if(playbackEn){
TickTock 36:dbd39c315258 484 playback.detach();
TickTock 36:dbd39c315258 485 playback.attach(&playbackISR,playbackInt);
TickTock 36:dbd39c315258 486 }
TickTock 36:dbd39c315258 487 }
TickTock 86:d1c9e8ac1c4b 488 } else {
TickTock 62:ffd15edb5431 489 lastDMode[whichTouched]=99;//repaint to clear highlight
TickTock 23:cd03f9c3395e 490 }
TickTock 62:ffd15edb5431 491
TickTock 23:cd03f9c3395e 492 break;
garygid 65:821fc79cd7fe 493
garygid 67:2022fce701d0 494 case 30: // right-most on top row
garygid 65:821fc79cd7fe 495
leafman 98:9f8bab96edff 496 if (dMode[whichTouched]==configScreen) {
garygid 65:821fc79cd7fe 497 // step through skins
garygid 65:821fc79cd7fe 498 if( skin < maxSkin ) skin += 1 ;
garygid 65:821fc79cd7fe 499 else skin = 0 ;
garygid 65:821fc79cd7fe 500
garygid 65:821fc79cd7fe 501 // repaint both screens, I think
garygid 65:821fc79cd7fe 502 lastDMode[whichTouched]=99;//repaint to clear highlight
garygid 65:821fc79cd7fe 503 // and re-paint the other screen too, to see new skin there
garygid 65:821fc79cd7fe 504 lastDMode[whichTouched ^ 1]=99; // repaint other screen (^ = XOR)
garygid 67:2022fce701d0 505 } else if (dMode[whichTouched] == indexScreen) { // gg - index
TickTock 122:138a40892a4c 506 dMode[whichTouched] = healthScreen ; // Goto health screen
TickTock 73:62ee8eae3a84 507 sMode=0;
TickTock 86:d1c9e8ac1c4b 508 } else {
garygid 65:821fc79cd7fe 509 lastDMode[whichTouched]=99;//repaint to clear highlight
garygid 65:821fc79cd7fe 510 }
garygid 65:821fc79cd7fe 511
garygid 65:821fc79cd7fe 512 break;
garygid 54:6ce808d0995e 513 //----------------------------------
garygid 54:6ce808d0995e 514 //----------------------------------
garygid 67:2022fce701d0 515 case 01: // left col middle row
leafman 98:9f8bab96edff 516 if (dMode[whichTouched]==configScreen) {
TickTock 23:cd03f9c3395e 517 logEn = !logEn;
garygid 67:2022fce701d0 518 } else if (dMode[whichTouched] == indexScreen) { // gg - index
TickTock 73:62ee8eae3a84 519 dMode[whichTouched] = cpScreen ; // GoTo CP Data Screen
TickTock 73:62ee8eae3a84 520 sMode=0;
TickTock 42:4533b13b297d 521 } else if (dMode[whichTouched]==dateScreen){
TickTock 131:0d926c080a65 522 dtMode=(dtMode<5)?dtMode+1:0;
TickTock 42:4533b13b297d 523 lastDMode[whichTouched]=99;
TickTock 62:ffd15edb5431 524 } else {
TickTock 62:ffd15edb5431 525 lastDMode[whichTouched]=99;//repaint to clear highlight
TickTock 23:cd03f9c3395e 526 }
TickTock 62:ffd15edb5431 527
TickTock 23:cd03f9c3395e 528 break;
garygid 54:6ce808d0995e 529 //------------------------------
TickTock 23:cd03f9c3395e 530 case 11:
leafman 98:9f8bab96edff 531 if (dMode[whichTouched]==configScreen){
TickTock 77:7c136766466c 532 repeatPoll = !repeatPoll;
TickTock 33:a277743ebdeb 533 if (repeatPoll) {
TickTock 36:dbd39c315258 534 autoPoll.attach(&autoPollISR,pollInt);
TickTock 33:a277743ebdeb 535 } else {
TickTock 36:dbd39c315258 536 autoPoll.detach();
TickTock 33:a277743ebdeb 537 }
garygid 67:2022fce701d0 538 } else if (dMode[whichTouched] == indexScreen) { // gg - index
garygid 67:2022fce701d0 539 dMode[whichTouched] = cpHistScreen ; // GoTo CP Hist Screen
TickTock 73:62ee8eae3a84 540 sMode=0;
TickTock 42:4533b13b297d 541 } else if (dMode[whichTouched]==playbackScreen) {
TickTock 36:dbd39c315258 542 // Start/stop playback
TickTock 36:dbd39c315258 543 if(!playbackOpen){
TickTock 131:0d926c080a65 544 if(!carCanIdle){
TickTock 131:0d926c080a65 545 printMsg("Cannot playback while connected to canbus\n");
TickTock 131:0d926c080a65 546 }else if(!logOpen){
TickTock 109:3e6f0e8fca0d 547 efr = f_open(&efile,"playback.alc",FA_READ|FA_OPEN_EXISTING);
TickTock 50:83d5864c64a0 548 lastDMode[whichTouched]=99;//force refresh
TickTock 109:3e6f0e8fca0d 549 if(efr != FR_OK){
TickTock 116:5cd72bae7c12 550 printMsg("Unable to open /usb/playback.alc\n"); // no playback.alc
TickTock 36:dbd39c315258 551 spkr.beep(1000,0.25);
TickTock 36:dbd39c315258 552 } else {
TickTock 36:dbd39c315258 553 playbackOpen = true;
TickTock 50:83d5864c64a0 554 playbackEn=true;
TickTock 50:83d5864c64a0 555 playback.attach(&playbackISR,playbackInt);
TickTock 116:5cd72bae7c12 556 printMsg("Starting playback\n"); // start playback
TickTock 36:dbd39c315258 557 spkr.beep(2000,0.25);
TickTock 138:a2f5af85ed0d 558 can1.attach(NULL);// Stop recieving EVCAN data
TickTock 138:a2f5af85ed0d 559 can2.attach(NULL);// Stop recieving CARCAN data
TickTock 36:dbd39c315258 560 }
TickTock 36:dbd39c315258 561 } else {
TickTock 117:49883c779a74 562 printMsg("Must stop logging first\n");
TickTock 36:dbd39c315258 563 }
TickTock 36:dbd39c315258 564 } else {
TickTock 36:dbd39c315258 565 playback.detach();
TickTock 109:3e6f0e8fca0d 566 f_close(&efile);
TickTock 36:dbd39c315258 567 playbackOpen=false;
TickTock 50:83d5864c64a0 568 playbackEn=false;
TickTock 138:a2f5af85ed0d 569 can1.attach(&recieve1);// Restore EVCAN data recieve
TickTock 138:a2f5af85ed0d 570 can2.attach(&recieve2);// Restore EVCAN data recieve
TickTock 42:4533b13b297d 571 lastDMode[whichTouched]=99;
TickTock 36:dbd39c315258 572 }
TickTock 42:4533b13b297d 573 } else if (dMode[whichTouched]==dateScreen){
TickTock 25:ddf0ec209f03 574 upDate(dtMode,true);
TickTock 42:4533b13b297d 575 lastDMode[whichTouched]=99;
TickTock 62:ffd15edb5431 576 } else {
TickTock 62:ffd15edb5431 577 lastDMode[whichTouched]=99;//repaint to clear highlight
TickTock 25:ddf0ec209f03 578 }
TickTock 62:ffd15edb5431 579
TickTock 23:cd03f9c3395e 580 break;
garygid 54:6ce808d0995e 581 //---------------------------------
garygid 54:6ce808d0995e 582 case 21: // col 2 row 1
leafman 98:9f8bab96edff 583 if (dMode[whichTouched]==configScreen) { // gg - Batt Log Enable Button
TickTock 48:d1ce92104a1f 584 yesBattLog = !yesBattLog;
garygid 67:2022fce701d0 585 } else if (dMode[whichTouched] == indexScreen) { // gg - index
garygid 67:2022fce701d0 586 dMode[whichTouched] = cpBarScreen ; // GoTo CP Bars Screen
TickTock 73:62ee8eae3a84 587 sMode=0;
TickTock 48:d1ce92104a1f 588 } else if (dMode[whichTouched]==dateScreen){
TickTock 25:ddf0ec209f03 589 upDate(dtMode,false);
TickTock 42:4533b13b297d 590 lastDMode[whichTouched]=99;
TickTock 62:ffd15edb5431 591 } else {
TickTock 62:ffd15edb5431 592 lastDMode[whichTouched]=99;//repaint to clear highlight
TickTock 25:ddf0ec209f03 593 }
TickTock 62:ffd15edb5431 594
TickTock 23:cd03f9c3395e 595 break;
garygid 54:6ce808d0995e 596
garygid 87:46ac3f2519d6 597 case 31: // col 3 row 1
leafman 98:9f8bab96edff 598 if (dMode[whichTouched]==configScreen) { // gg - Batt Log Enable Button
garygid 87:46ac3f2519d6 599 debugMode = !debugMode;
leafman 98:9f8bab96edff 600 } else if (dMode[whichTouched] == indexScreen) { // gg - index
leafman 98:9f8bab96edff 601 dMode[whichTouched] = configScreen ; // GoTo Config Screen
TickTock 107:e9be732c1ad4 602 } else if (dMode[whichTouched] == tripScreen) {
TickTock 108:29b5a760adc2 603 miles_trip[1]=0;
TickTock 108:29b5a760adc2 604 kWh_trip[1]=0;
TickTock 108:29b5a760adc2 605 sMode=0;
TickTock 108:29b5a760adc2 606 lastDMode[whichTouched]=99;//repaint to clear highlight
garygid 87:46ac3f2519d6 607 } else {
garygid 87:46ac3f2519d6 608 lastDMode[whichTouched]=99;//repaint to clear highlight
garygid 87:46ac3f2519d6 609 }
garygid 87:46ac3f2519d6 610 break;
garygid 87:46ac3f2519d6 611
garygid 54:6ce808d0995e 612 //-----------------------------------
garygid 67:2022fce701d0 613 case 02: // left col, bottom row (not nav)
garygid 67:2022fce701d0 614 if (dMode[whichTouched] == indexScreen) { // gg - index
leafman 98:9f8bab96edff 615 dMode[whichTouched] = playbackScreen ; // GoTo Playback Screen
leafman 98:9f8bab96edff 616 } else if (dMode[whichTouched]==configScreen) {
TickTock 140:ab3e94eb0227 617 brakeMon = !brakeMon;
TickTock 140:ab3e94eb0227 618 if(brakeMon){
TickTock 140:ab3e94eb0227 619 geiger.attach(&chirp,0.02);
TickTock 140:ab3e94eb0227 620 }else{
TickTock 140:ab3e94eb0227 621 geiger.detach();
TickTock 140:ab3e94eb0227 622 }
garygid 87:46ac3f2519d6 623 } else {
garygid 87:46ac3f2519d6 624 lastDMode[whichTouched]=99;//repaint to clear highlight
garygid 87:46ac3f2519d6 625 }
garygid 67:2022fce701d0 626 break;
garygid 67:2022fce701d0 627
garygid 67:2022fce701d0 628 case 12: // left-middle col, bottom row (not nav)
TickTock 131:0d926c080a65 629 if (dMode[whichTouched] == configScreen) { // gg - index
leafman 98:9f8bab96edff 630 dMode[whichTouched] = dateScreen ; // GoTo Set Date/Time Screen
garygid 87:46ac3f2519d6 631 } else {
garygid 87:46ac3f2519d6 632 lastDMode[whichTouched]=99;//repaint to clear highlight
garygid 87:46ac3f2519d6 633 }
garygid 67:2022fce701d0 634 break;
garygid 67:2022fce701d0 635
garygid 67:2022fce701d0 636 case 22: // right-middle col, bottom row (not nav)
garygid 67:2022fce701d0 637 if (dMode[whichTouched] == indexScreen) { // gg - index
leafman 98:9f8bab96edff 638 dMode[whichTouched] = logScreen ;
TickTock 131:0d926c080a65 639 } else if (dMode[whichTouched]==configScreen) {
TickTock 131:0d926c080a65 640 showHealth = !showHealth;
garygid 87:46ac3f2519d6 641 } else {
garygid 87:46ac3f2519d6 642 lastDMode[whichTouched]=99;//repaint to clear highlight
garygid 87:46ac3f2519d6 643 }
garygid 67:2022fce701d0 644 break;
TickTock 72:f9a6faa28873 645
leafman 98:9f8bab96edff 646 case 32: // right col, bottom row (not nav)
leafman 98:9f8bab96edff 647 if (dMode[whichTouched] == configScreen) {
TickTock 114:3f8c59a8a2b9 648 logEn=false;
leafman 98:9f8bab96edff 649 updateFirmware();
TickTock 107:e9be732c1ad4 650 } else if (dMode[whichTouched] == tripScreen) {
TickTock 108:29b5a760adc2 651 miles_trip[2]=0;
TickTock 108:29b5a760adc2 652 kWh_trip[2]=0;
TickTock 73:62ee8eae3a84 653 sMode=0;
TickTock 108:29b5a760adc2 654 lastDMode[whichTouched]=99;//repaint to clear highlight
TickTock 108:29b5a760adc2 655 } else if (dMode[whichTouched] == indexScreen) {
TickTock 108:29b5a760adc2 656 dMode[whichTouched] = tripScreen ;
leafman 98:9f8bab96edff 657 } else {
garygid 87:46ac3f2519d6 658 lastDMode[whichTouched]=99;//repaint to clear highlight
TickTock 72:f9a6faa28873 659 }
TickTock 72:f9a6faa28873 660 break;
TickTock 72:f9a6faa28873 661
garygid 67:2022fce701d0 662 //-----------------------------------
garygid 54:6ce808d0995e 663 //-----------------------------------
garygid 54:6ce808d0995e 664 // Prev Navigation
garygid 54:6ce808d0995e 665 case 07: // col 0 row tNavRow
TickTock 42:4533b13b297d 666 dMode[whichTouched]=dMode[whichTouched]>0?dMode[whichTouched]-1:maxScreens;
TickTock 22:a43df3905863 667 break;
garygid 54:6ce808d0995e 668 //-----------------------------------
garygid 54:6ce808d0995e 669 // Select Screen Navigation
garygid 54:6ce808d0995e 670 case 17:
TickTock 43:e7f6f80590e3 671 sMode=0;
TickTock 43:e7f6f80590e3 672 lastDMode[whichTouched]=99; // Repaint
TickTock 22:a43df3905863 673 break;
garygid 54:6ce808d0995e 674 //-----------------------------------
garygid 54:6ce808d0995e 675 // Index Navigation
garygid 54:6ce808d0995e 676 case 27: // col 2 row tNavRow
garygid 67:2022fce701d0 677 dMode[whichTouched]= indexScreen ; // gg - index
garygid 54:6ce808d0995e 678 break;
garygid 54:6ce808d0995e 679 //------------------------------------
garygid 54:6ce808d0995e 680 // Next Navigation
garygid 54:6ce808d0995e 681 case 37: // lower right on Nav Line gg - move next
TickTock 42:4533b13b297d 682 dMode[whichTouched]=dMode[whichTouched]<maxScreens?dMode[whichTouched]+1:0;
TickTock 22:a43df3905863 683 break;
garygid 54:6ce808d0995e 684 //------------------------------------
garygid 54:6ce808d0995e 685 //------------------------------------
TickTock 22:a43df3905863 686 default:
TickTock 62:ffd15edb5431 687 lastDMode[whichTouched]=99;//repaint to clear highlight
TickTock 25:ddf0ec209f03 688 break;
TickTock 25:ddf0ec209f03 689 }
TickTock 23:cd03f9c3395e 690 break;
TickTock 23:cd03f9c3395e 691 case 2: // numpad
TickTock 23:cd03f9c3395e 692 break;
TickTock 23:cd03f9c3395e 693 case 3:
TickTock 23:cd03f9c3395e 694 break;
TickTock 23:cd03f9c3395e 695 default:
TickTock 23:cd03f9c3395e 696 break;
TickTock 23:cd03f9c3395e 697 } // case sMode
TickTock 22:a43df3905863 698 } //recently touched
TickTock 4:8d7759f4fe7a 699 } else { // userIdle
TickTock 8:67eed72f3e10 700 if(sMode==1){
TickTock 8:67eed72f3e10 701 sMode=0;
TickTock 43:e7f6f80590e3 702 lastDMode[whichTouched]=99;
TickTock 8:67eed72f3e10 703 }
TickTock 4:8d7759f4fe7a 704 }
TickTock 34:4751a8259b18 705
TickTock 34:4751a8259b18 706 if(tick){ // Executes once a second
TickTock 108:29b5a760adc2 707 tick=false;
TickTock 93:c2402e8cd0e2 708 headlights = (lastMsg[indexLastMsg[0x358]].data[1]&0x80)?true:false; // headlight/turn signal indicator
TickTock 140:ab3e94eb0227 709 miles_kmbar = (lastMsg[indexLastMsg[0x355]].data[4]&0x20)?true:false; // indicates selected distance units
TickTock 140:ab3e94eb0227 710 metric = !miles_kmbar;
TickTock 41:8d4609ea7259 711 accV=floor(mon12V*scale12V*10+0.5)/10; //Round to nearest 10th
TickTock 35:5acbd8a64a89 712 accOn=(accV>5)?true:false;
TickTock 131:0d926c080a65 713 moving=(mph[0]>0.1);
TickTock 131:0d926c080a65 714 charging=!moving&&(kW[0]<-1); // not moving and generating energy so must be charging
TickTock 134:ad243e4f1a17 715 if (laccOn&&!accOn){ // Car turned off
TickTock 134:ad243e4f1a17 716 if (showHealth){
TickTock 134:ad243e4f1a17 717 if (saveDmode==99){
TickTock 134:ad243e4f1a17 718 saveDmode=dMode[0];
TickTock 134:ad243e4f1a17 719 }
TickTock 134:ad243e4f1a17 720 dMode[0]=healthScreen;
TickTock 135:89986950d501 721 secsNoTouch=2;// Keep display on a few seconds
TickTock 134:ad243e4f1a17 722 sMode=0;
TickTock 134:ad243e4f1a17 723 userIdle=false;
TickTock 134:ad243e4f1a17 724 }
TickTock 132:08748a67280a 725 // Keep track of max and min trip efficiency
TickTock 134:ad243e4f1a17 726 if (miles_trip[0]>3){ // Ignore very short trips
TickTock 134:ad243e4f1a17 727 float tmpeff = miles_trip[0]/kWh_trip[0];
TickTock 134:ad243e4f1a17 728 if (maxTripEff<tmpeff) {
TickTock 134:ad243e4f1a17 729 maxTripEff=tmpeff;
TickTock 134:ad243e4f1a17 730 }
TickTock 134:ad243e4f1a17 731 if (minTripEff>tmpeff) {
TickTock 134:ad243e4f1a17 732 minTripEff=tmpeff;
TickTock 134:ad243e4f1a17 733 }
TickTock 132:08748a67280a 734 }
TickTock 108:29b5a760adc2 735 if (repeatPoll) { // Log on shutdown if autopoll enabled
TickTock 108:29b5a760adc2 736 tripLog(); // Write trip log on powerdown
TickTock 108:29b5a760adc2 737 }
TickTock 49:a3d2c5bb3cfa 738 //write efficiency history data
TickTock 97:a25940fd7b5b 739 hfile = fopen("/local/ehist.cny", "w");
TickTock 97:a25940fd7b5b 740 if (hfile!=NULL){ // found a efficiency history file
TickTock 49:a3d2c5bb3cfa 741 for(i=0;i<39;i++){
TickTock 97:a25940fd7b5b 742 fprintf(hfile,"%f %f\r\n",mph[i],kW[i]);
TickTock 49:a3d2c5bb3cfa 743 }
TickTock 134:ad243e4f1a17 744 fprintf(hfile,"%f %f\r\n",maxTripEff,minTripEff); // Save max and min
TickTock 97:a25940fd7b5b 745 fclose(hfile);
TickTock 49:a3d2c5bb3cfa 746 }
TickTock 49:a3d2c5bb3cfa 747 }
TickTock 134:ad243e4f1a17 748 if (!laccOn&&accOn){ // Car turned on
TickTock 108:29b5a760adc2 749 miles_trip[0]=0;
TickTock 108:29b5a760adc2 750 kWh_trip[0]=0;
TickTock 115:549410af477d 751 wait5secs=5;
TickTock 134:ad243e4f1a17 752 if (showHealth){
TickTock 134:ad243e4f1a17 753 if (saveDmode==99){
TickTock 134:ad243e4f1a17 754 saveDmode=dMode[0];
TickTock 134:ad243e4f1a17 755 }
TickTock 131:0d926c080a65 756 dMode[0]=healthScreen;
TickTock 131:0d926c080a65 757 }
TickTock 115:549410af477d 758 }
TickTock 49:a3d2c5bb3cfa 759 laccOn=accOn;
TickTock 135:89986950d501 760 if(!accOn&&userIdle&&!playbackEn){ // Car off and no user activity - turn off screen
TickTock 134:ad243e4f1a17 761 dled = 0;
TickTock 134:ad243e4f1a17 762 if (saveDmode<99){
TickTock 134:ad243e4f1a17 763 dMode[0]=saveDmode;
TickTock 134:ad243e4f1a17 764 saveDmode=99;
TickTock 134:ad243e4f1a17 765 }
TickTock 35:5acbd8a64a89 766 }else if(!headlights){
TickTock 35:5acbd8a64a89 767 dled = ledHi;
TickTock 115:549410af477d 768 } else {
TickTock 35:5acbd8a64a89 769 dled = ledLo;
TickTock 34:4751a8259b18 770 }
TickTock 115:549410af477d 771 if(wait5secs>0){ // Wait a few seconds after poweron to give BMS time to measure CP's
TickTock 115:549410af477d 772 wait5secs-=1;
TickTock 115:549410af477d 773 if (repeatPoll&&(wait5secs==0)) { // Poll on startup if autopoll enabled
TickTock 108:29b5a760adc2 774 logOnce=true;
TickTock 112:b41b35401eb6 775 reqMsgCnt=0;
TickTock 138:a2f5af85ed0d 776 //sendTempReq();
TickTock 124:0d622967b764 777 msgReq.attach(&sendReq,0.015);
TickTock 108:29b5a760adc2 778 }
TickTock 135:89986950d501 779 lastDMode[0]=99;
TickTock 135:89986950d501 780 lastDMode[1]=99;
TickTock 107:e9be732c1ad4 781 }
TickTock 134:ad243e4f1a17 782
TickTock 134:ad243e4f1a17 783 //remove health screen once moving
TickTock 131:0d926c080a65 784 if(moving&&(saveDmode<99)&&(wait5secs==0)){
TickTock 131:0d926c080a65 785 dMode[0]=saveDmode;
TickTock 131:0d926c080a65 786 saveDmode=99;
TickTock 131:0d926c080a65 787 }
TickTock 115:549410af477d 788
TickTock 49:a3d2c5bb3cfa 789 //compute historic efficiency
TickTock 41:8d4609ea7259 790 if(numSsamples>0){ // Avoid div0
TickTock 115:549410af477d 791 mph[0]=((float) motorRPM)/numSsamples/220; // Empirically derived with MXV4s - may change with different wheels&tires
TickTock 86:d1c9e8ac1c4b 792 } else {
TickTock 49:a3d2c5bb3cfa 793 mph[0]=0;
TickTock 36:dbd39c315258 794 }
TickTock 49:a3d2c5bb3cfa 795 if(mph[0]>99){
TickTock 49:a3d2c5bb3cfa 796 mph[0]=0;
TickTock 49:a3d2c5bb3cfa 797 }
TickTock 121:553faf139a20 798 numSsamples=0;
TickTock 107:e9be732c1ad4 799
TickTock 41:8d4609ea7259 800 if(numWsamples>0){ // Avoid div0
TickTock 121:553faf139a20 801 mpkWh[0]=mph[0];
TickTock 49:a3d2c5bb3cfa 802 kW[0]=((float) mWs_x4)/numWsamples/4e3;
TickTock 49:a3d2c5bb3cfa 803 mpkWh[0]/=kW[0];
TickTock 49:a3d2c5bb3cfa 804 if (mpkWh[0]<0) {
TickTock 49:a3d2c5bb3cfa 805 mpkWh[0]=99;// negative means inf.
TickTock 49:a3d2c5bb3cfa 806 }
TickTock 86:d1c9e8ac1c4b 807 } else {
TickTock 49:a3d2c5bb3cfa 808 kW[0]=0;
TickTock 49:a3d2c5bb3cfa 809 mpkWh[0]=0;
TickTock 49:a3d2c5bb3cfa 810 }
TickTock 121:553faf139a20 811 numWsamples=0;
TickTock 121:553faf139a20 812
TickTock 121:553faf139a20 813 if (!charging){
TickTock 121:553faf139a20 814 miles_trip[0]+=mph[0]/3600;
TickTock 121:553faf139a20 815 miles_trip[1]+=mph[0]/3600;
TickTock 121:553faf139a20 816 miles_trip[2]+=mph[0]/3600;
TickTock 121:553faf139a20 817 kWh_trip[0]+=kW[0]/3600;
TickTock 121:553faf139a20 818 kWh_trip[1]+=kW[0]/3600;
TickTock 121:553faf139a20 819 kWh_trip[2]+=kW[0]/3600;
TickTock 121:553faf139a20 820 }
TickTock 121:553faf139a20 821
TickTock 49:a3d2c5bb3cfa 822 motorRPM=0;
TickTock 40:0e6e71a7323f 823 mWs_x4=0;
TickTock 121:553faf139a20 824
TickTock 121:553faf139a20 825 // Compute ESR
TickTock 121:553faf139a20 826 if((Imax-Imin)<40){ // do nothing - insufficient delta_I to measure
TickTock 121:553faf139a20 827 unloadedV_x2 = (curRmax+curRmin)/2;
TickTock 120:041edeec08f5 828 }else if ((redRmax-redRmin)<(curRmax-curRmin)) {
TickTock 120:041edeec08f5 829 Resr-=0.001;
TickTock 120:041edeec08f5 830 unloadedV_x2 = (redRmax+redRmin)/2;
TickTock 120:041edeec08f5 831 } else if ((incRmax-incRmin)<(curRmax-curRmin)) {
TickTock 120:041edeec08f5 832 Resr+=0.001;
TickTock 120:041edeec08f5 833 unloadedV_x2 = (incRmax+incRmin)/2;
TickTock 120:041edeec08f5 834 } else {
TickTock 120:041edeec08f5 835 unloadedV_x2 = (curRmax+curRmin)/2;
TickTock 120:041edeec08f5 836 }
TickTock 120:041edeec08f5 837 curRmin=1000;
TickTock 120:041edeec08f5 838 curRmax=0;
TickTock 120:041edeec08f5 839 incRmin=1000;
TickTock 120:041edeec08f5 840 incRmax=0;
TickTock 120:041edeec08f5 841 redRmin=1000;
TickTock 120:041edeec08f5 842 redRmax=0;
TickTock 121:553faf139a20 843 Imax=-1000;
TickTock 121:553faf139a20 844 Imin=1000;
TickTock 121:553faf139a20 845
TickTock 121:553faf139a20 846 if((accOn||playbackEn)&&!charging){
TickTock 52:d5385fbf4ea1 847 for(i=1;i<39;i++){
TickTock 49:a3d2c5bb3cfa 848 average=mph[i]/timeConstant[i];
TickTock 49:a3d2c5bb3cfa 849 mph[i]-=average;
TickTock 52:d5385fbf4ea1 850 mph[i]+=mph[0];
TickTock 52:d5385fbf4ea1 851 mpkWh[i]=average;
TickTock 49:a3d2c5bb3cfa 852 average=kW[i]/timeConstant[i];
TickTock 121:553faf139a20 853 if(!charging){ //Not charging - so include in efficiency data
TickTock 97:a25940fd7b5b 854 kW[i]-=average;
TickTock 97:a25940fd7b5b 855 kW[i]+=kW[0];
TickTock 97:a25940fd7b5b 856 }
TickTock 52:d5385fbf4ea1 857 mpkWh[i]/=average;
TickTock 49:a3d2c5bb3cfa 858 if (mpkWh[i]<0) {
TickTock 49:a3d2c5bb3cfa 859 mpkWh[i]=99;// negative means inf.
TickTock 49:a3d2c5bb3cfa 860 }
TickTock 49:a3d2c5bb3cfa 861 //mpkWh[i]=floor(mpkWh[i]*10+0.5)/10; // Round to nearest 10th
TickTock 52:d5385fbf4ea1 862 }
TickTock 49:a3d2c5bb3cfa 863 }
TickTock 108:29b5a760adc2 864 if(logCP&&usbEn){
TickTock 108:29b5a760adc2 865 if(logOnce){
TickTock 108:29b5a760adc2 866 tripLog();
TickTock 108:29b5a760adc2 867 logOnce=false;
TickTock 108:29b5a760adc2 868 }
garygid 69:6bfdfc002036 869 logPackVoltages(); // Turbo3, only call
TickTock 108:29b5a760adc2 870 }
TickTock 137:70853cf5a30f 871 if(!usbEn){
TickTock 108:29b5a760adc2 872 usbEn=detectUSB(); // Keep looking if none found
TickTock 132:08748a67280a 873 if(usbEn){ // Force update to clear USB init garbage
TickTock 132:08748a67280a 874 lastDMode[0]=99;
TickTock 132:08748a67280a 875 lastDMode[1]=99;
TickTock 132:08748a67280a 876 }
TickTock 108:29b5a760adc2 877 }
TickTock 121:553faf139a20 878 tock=true;
TickTock 121:553faf139a20 879 } // tick
TickTock 39:eef8beac7411 880
TickTock 36:dbd39c315258 881 if(step){ // playback
TickTock 36:dbd39c315258 882 if(playbackOpen&&playbackEn){
TickTock 38:155ec32c5e91 883 for(i=0;i<120;i++){
TickTock 109:3e6f0e8fca0d 884 if(!f_eof(&efile)){
TickTock 109:3e6f0e8fca0d 885 efr=f_read(&efile,&header,5,&bytesRW);
TickTock 109:3e6f0e8fca0d 886 efr=f_read(&efile,&data,8,&bytesRW);
garygid 69:6bfdfc002036 887 logCan(header[0],CANMessage(0x7ff&((header[4]<<8)+header[3]), data, 8)); // Playback
TickTock 86:d1c9e8ac1c4b 888 } else {
TickTock 109:3e6f0e8fca0d 889 f_close(&efile); // restart
TickTock 109:3e6f0e8fca0d 890 efr = f_open(&efile,"playback.alc",FA_READ|FA_OPEN_EXISTING);
TickTock 50:83d5864c64a0 891 lastDMode[whichTouched]=99;//force refresh
TickTock 36:dbd39c315258 892 spkr.beep(2000,0.25);
TickTock 36:dbd39c315258 893 }
TickTock 36:dbd39c315258 894 }
TickTock 36:dbd39c315258 895 }
TickTock 36:dbd39c315258 896 step=false;
TickTock 36:dbd39c315258 897 }
TickTock 37:fea2c1d52c5f 898
TickTock 140:ab3e94eb0227 899 display=display<1?display+1:0; // toggle display
TickTock 140:ab3e94eb0227 900 updateDisplay(display);
TickTock 2:71b1999a8ea5 901 } //while (true)
TickTock 0:1596b8644523 902 }