Dual CANbus monitor and instrumentation cluster. Presently tuned for the Nissan Leaf EV.

Dependencies:   SPI_TFTx2_ILI9341 TFT_fonts TOUCH_TFTx2_ILI9341 mbed

Fork of CANary_corrupt by Tick Tock

After adding the LPC1768 platform, import as a program and do not select the "update to latest revision" box

User Guide

Eagle Schematic and Board design

/media/uploads/TickTock/canaryr6.zip

/media/uploads/TickTock/canary_sch.jpg

/media/uploads/TickTock/canaryr6brd.jpg

For LCD Rev 1.01:

/media/uploads/TickTock/lcdsch.jpg

For VCD Rev 2.00:

/media/uploads/TickTock/lcdr2.jpg

Parts List

qtyinstancepart #packagesupplierDescription
1BAT3Vhttp://www.ebay.com/itm/10x-CR2032-SMD-Battery-Holder-for-CR2032-Battery-/180938057979?pt=LH_DefaultDomain_0&hash=item2a20bfa8fbLithium 2032 coin battery holder
4C1-C4ECST1DC106R6032Tantalium capacitor 10uF
3FC1-FC3ZF1-20-01-T-WThttp://www.samtec.com/cable-systems/idc-ffc/ffc/zero-insertion.aspx20 conductor 1mm pitch flex cable connector (optional)
1FJ-20-R-08.00-4http://www.samtec.com/cable-systems/idc-ffc/ffc/zero-insertion.aspx8\" 20 conductor 1mm pitch flex connector, end reversed (optional)
2H1-H4(DON'T populate H1-H4 headers - solder mbed directly)
1H5http://www.ebay.com/itm/221186042943?ssPageName=STRK:MEWNX:IT&_trksid=p3984.m1497.l26491x12 .1\" pitch header (optional)
1H62x6 .1\" pitch header (optional)
2IC1,IC2VP230LMDSOP8http://www.ebay.com/itm/130488665247?ssPageName=STRK:MEWNX:IT&_trksid=p3984.m1497.l2649canbus transciever
1IC3LM1117-5VSOT2235V regulator
5JP*2 pin .1\" jumper header
1mbedLPC1768http://www.ebay.com/itm/200830573509?ssPageName=STRK:MEWNX:IT&_trksid=p3984.m1497.l2649mbed uC
2Q1,Q22N2222SOT23General purpose NPN transistor
1R1R393M120639K resistor
1R2R103M120610K resistor
4R4-R6R102M12061K resistor
1R3R500M120650 Ohm resistor
2TR1-TR5ZJYS81R5-2PL51TG01http://www.digikey.com/product-detail/en/ZJYS81R5-2PL51T-G01/445-2223-1-ND/765232CM Choke
1Z11N5340BGC1702-15http://www.ebay.com/itm/150878122425?ssPageName=STRK:MEWNX:IT&_trksid=p3984.m1497.l26496V, 5W Zener Diode
1Z1DC-DC conveterhttp://www.ebay.com/itm/251142727849?ssPageName=STRK:MEWNX:IT&_trksid=p3984.m1497.l264912V-7V, 3W DC-DC converter
1X1USBhttp://www.ebay.com/itm/New-Vertical-USB-2-0-A-pcb-connector-socket-USB-A-Type-/300553895292?pt=LH_DefaultDomain_0&hash=item45fa687d7cvertical USB connector
2LCD0,LCD1TFThttp://www.mikroe.com/add-on-boards/display/tft-proto/320x240 LCD with touch screen
1E0Enclosurehttp://www.shapeways.com/model/1077799/canary.html?li=user-profile&materialId=63d printed enclosure

Assembly

1) LCD Displays

I found ribbon cable is a nice way to organize the wires to the displays. There are two versions of the display and each must be wired differently. The original project used HW REV. 1.01. For that version, you'll need 12 conductors and I connected them in the following order:

1LED+
2LED-
3RST
4SDI
5WR/SCLK
6CS
7X+
8X-
9Y+
10Y-
11VDD
12GND

If, instead, you have HW REV 2.0, you will need 13 conductors with the following order:

1LED+
2LED-
3RST
4SDI
5RS (SCLK)
6WR (DC)
7CS
8X+
9X-
10Y+
11Y-
12VDD
13GND

First I connected all the GND connections (2 GND & IM0, IM1, IM3 for REV1.01 or 2 GND, RD, & IM0 for REV2.00). Do not connect the bottom GND until you have the ribbon cable connected. After making all the ribbon cable connections (connecting the GND of the ribbon cable to the bottom GND pad), solder the GND bar from the previous step to the back of the bottom GND connection. Finally, make a connection from the back side 3.3V pin to IM2 for REV1.01 or to IM1,IM2,&IM3 for REV2.00. Take a break and repeat for the second display.

Examples of REV1.01 boards:

/media/uploads/TickTock/lcdtop.jpg /media/uploads/TickTock/lcdbot.jpg

Examples of REV2.00:

/media/uploads/TickTock/rev2front.jpg /media/uploads/TickTock/rev2back.jpg

Once the two displays are complete combine all wires except CS0, CS1, X+, X-, Y+, and Y-. Connect X- of the left display to X+ of the right. Similarly connect Y- of the left display to Y+ of the right. Insulate any exposed wires.

2) PCB

Refer to the schematics to place all the components on the board. If you plan to install into the CANary 3D enclosure, DO NOT install the battery holder or the socket for the mbed and, instead, connect two wires to the VB and GND pads nearby. You will have to install the battery holder against the back wall to avoid interfering with the right-hand display and the mbed will have to be directly soldered. I have not found a socket with a low enough profile to fit in the space provided (depth of enclosure is limited by the space behind the center console). Also, I recommend keeping as much lead as possible on the Zener diode (bending it as shown to clear the back wall). Although it is operating well within parameters, the Zener gets quite hot during extended operation and the leads help dissipate the heat and keep it away from the PCB and other components.Update: Several Zeners have failed resulting in damage to some users boards so I recommend using a DC-DC converter instead to bring the 12V down to 7V.

/media/uploads/TickTock/pcbtop.jpg /media/uploads/TickTock/pcbbot.jpg

Once the PCB is populated, solder the LCDs to the PCB. CS0 connects to the right display and CS1 connects to the left. /media/uploads/TickTock/brddis.jpg

Update: The Zener diodes tended to fail after a few months so I am recommending removing them and replacing with a DC-DC converter. This will run cooler and waste less energy, too. To install, remove the left display panel to gain access to the Zener. From there, the Zener can be removed and it's pads used to connect to the DC-DC converter. I recommend setting the output voltage on the bench before installing since the trim pot is tricky to reach once installed. Set it to 7V. The input can be connected to the left pad previously occupied by the zener and the output can connect to the right. GND(-) can be connected to the bottom right pad on the 2x6 header below the flex cable connector. Make sure the GND wire lies flat so it doesn't interfere with the connection of the flex cable. /media/uploads/TickTock/dcdcinst2.jpg

Once soldered in place, the DC-DC converter can easily be mounted to the back wall with double sided tape above the battery holder. /media/uploads/TickTock/dcdcinst3.jpg

3) Testing

1)First step is to buzz out all connections from the LCDs to the pins in the main board
2)Next check the touch screen connections. On the main board, place an Ohm meter across X+ and X-. You should read 700 Ohms. Repeat for Y+ and Y-. Then test the resistance from X+ to Y+. With nothing touching the screens, it should read >100K Ohms and <1K when touching either screen.
3)When all connections are checked, solder in the mbed. Download and install the touch2 program http://mbed.org/users/TickTock/code/touch2/ to test the basic operation of the mbed and touch screens.
tips:
Touch screen is sensitive - excess flux on X+,X-,Y+,Y- connection on mbed can result in flakey operation
If touch is not working, double-check the LCD0_CS and LCD1_CS are not swapped. LCD0_CS must connect to the CS of the LCD that has X- & Y- connected to the mbed. LCD1_CS must connect to the CS of the LCD that has X+ & Y+ connected to the mbed.
4)Once touch2 works, it is time to connect to the OBD connector. I highly recommend double checking all connections from the OBD to the PCB with the cable in place before connecting to the Leaf. Buzz out all the pins in the OBS to make sure none are shorting to each other, Check that the 12V goes to the Zener (and nothing else) and the switched 12V to the resistor divider (and nothing else). Test the ground connection properly connects to ground and nothing else.
5)Once you are confident there are no shorts or wrong connections from the OBD connector, take a deep breath and plug it into your leaf. Touch2 program should come up and function. Unplug and install the latest CANary firmware. If you have the REV2.00 LCD boards, you will need to edit the precompile.h file in the TOUCH_TFTx2_w9341 library and set USE_ILI9341 to 1. Test all features before installing into the enclosure (gids, cellpair, menu system, logging) since installing and removing from the enclosure is a PITA.

/media/uploads/TickTock/pcbdone.jpg /media/uploads/TickTock/functioning.jpg

4) Enclosure

The 3D printer leaves a lot of powder behind - I used a strong spray of water to get it out of all the cracks. The enclosure comes with a rather rough finish. I recommend convincing yourself you like it, then simply lightly sand then paint before assembly. Sanding is very difficult - the nylon is very nicely fused and doesn't want to sand. I tried sandblasting and that didn't work either. I had some limited success with filler and then sanding, but only on the outside - it is too difficult to sand the face. /media/uploads/TickTock/enclosure.jpg

5) Final Assembly

Make sure you are well rested with lots of patience before attempting assembly. It is a puzzle figuring out how to get both displays and the PCB in place. Enclosure was too expensive for me to keep iterating to optimize for assembly. I ended up snipping the thin display posts shorter and using various tools to push the displays into place. Also, some USB connectors are taller than others. If you have one of the taller ones, you will have to deflect the back wall a bit while inserting the PCB (being careful not to bend the housing) to get it to it's opening in the back wall. Do use a screw in the provided post to secure the PCB as USB insertion will otherwise dislodge it.

I added an additional safety line which wraps around the center post to prevent the enclosure from becoming a projectile in the event of an accident. /media/uploads/TickTock/safety.jpg Installed: /media/uploads/TickTock/installed.jpg

Committer:
TickTock
Date:
Sun Oct 06 14:49:09 2013 +0000
Revision:
152:a4d66901785d
Parent:
151:3047ebb3c9a8
Child:
153:e94cfe3c339c
// Added clock sync with car clock option (MY2011,2012 only); // Fixed wrap bug in manual date update (january=00, not 01);

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