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:
Wed Oct 30 03:16:51 2013 +0000
Revision:
157:1a100a5ed06f
Parent:
156:4e5d30535cf9
Child:
158:059abeb44ba1
// Added trip max/min efficiency reset; // Added second config screen and RegenMon enable/disable

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