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:
Fri Jul 26 04:35:31 2013 +0000
Revision:
135:89986950d501
Parent:
134:ad243e4f1a17
Child:
136:41a204105511
Hide buttons on health screen on powerdown; Turn off screen even if logging if car off and user idle;

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