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 20:39:16 2013 +0000
Revision:
141:cf13a632ddb5
Parent:
140:ab3e94eb0227
Child:
142:c1a11d6f181c
tweaked brakeMon sensitivity and threshold

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