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:
Tue Aug 06 01:26:17 2013 +0000
Revision:
144:b0c9d30dd346
Parent:
143:88b5155622a5
Child:
145:47cdacc468a4
added accessory volt read from battData; put a copy of the config.txt on the USB drive during firmware update; added current trip efficiency below 10 minute efficiency to dte display;

Who changed what in which revision?

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