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:
Thu Jul 25 14:32:54 2013 +0000
Revision:
134:ad243e4f1a17
Parent:
133:b0675d9d11dd
Child:
135:89986950d501
Added orange highlight if psi<32; Qualified max and min trip efficiency update with trips > 3 miles; Keep mbed asleep during charging (EVcan only) unless logging active; Added miles & kWh to trip log;

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