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:
Sat Jul 27 22:19:01 2013 +0000
Revision:
136:41a204105511
Parent:
135:89986950d501
Child:
137:70853cf5a30f
Updated mainDisplay

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