Tick Tock
test fork
Dependencies: SPI_TFTx2 SPI_TFTx2_ILI9341 TFT_fonts TOUCH_TFTx2 mbed
Fork of
CANary_9341
by 
Tick Tock
main.cpp
- Committer:
- TickTock
- Date:
- 2014-05-12
- Revision:
- 187:447874df5cbe
- Parent:
- 186:d1f9b57fdd27
File content as of revision 187:447874df5cbe:
// main.cpp
//
//To Do:
// * Fix USB hot plug (must reset every time USB plugged)
// * Add 50% charge option
// * Add linear efficiency graph with 10 minute values
// * Add in-device config editor
// * Change pack volt color when CVLI fails
// * Add tire pressure cal (40psi for me = FR 38, RR 38.2, FL 37.8, RL 38 - maybe 2psi error on my tire gauge?)
// * Add on screen messages for heater on, etc, and use refresh feature above to clear in x seconds
// * Be more efficient with write buffer (use msgLen instead of always storing 8 bytes)
// rev184
// Fixed wh adjustment algorithm
#include "mbed.h"
#include "CAN.h"
#include "ff.h"
#include "PowerControl.h"
#include "EthernetPowerControl.h"
#include "utility.h"
#include "displayModes.h"
#include "TOUCH_TFTx2.h"
char revStr[7] = "184";
unsigned long maxTarget = 1000;
FATFS USBdrive;
LocalFileSystem local("local");
unsigned char wait5secs = 5;
// to write to USB Flash Drives, or equivalent (SD card in Reader/Writer)
// class10 SDcard in Reader/Writer recommended
FRESULT mfr = f_mount(0,&USBdrive);
time_t seconds ;
Ticker autoPoll;
Ticker playback;
Ticker msgReq;
Ticker geiger;
Timer timer;
DigitalOut led1(LED1);
DigitalOut led2(LED2);
DigitalOut led3(LED3);
DigitalOut led4(LED4);
InterruptIn touchpad(p17);
CAN can1(p9, p10); // CAN1 (EV) uses pins 9 and 10 (rx, tx) and pin 8 (rs)
DigitalOut can1SleepMode(p8); // Use pin 8 to control the sleep mode of can2
CAN can2(p30, p29); // CAN2 (CAR) uses pins 30 and 29 (rx, tx) and pin 28 (rs)
DigitalOut can2SleepMode(p28); // Use pin 28 to control the sleep mode of can1
AnalogIn mon12V(p15);
TOUCH_TFTx2 tt(p16, p17, p19, p20, p11, p12, p13, p6, p7, p5, p14, "TFT"); // x+, x-, y+, y-, mosi, miso, sclk, cs0, cs1, reset, dc
PwmOut dled(p23);
PwmOut spkr(p21);
bool debugMode = false;
bool usbEn = false;
bool logEn = false;
bool logOpen = false;
bool yesBattLog = true; // gg - Batt Log
unsigned char tNavRow = 3; // gg - 4x4 touch
bool brakeMon = false; // disable until desired value read from config
bool regenMon = false;
bool heaterMon = false;
bool autoSync = false; // auto clock sync on powerup
bool syncDone = true;
bool heaterOn = false;
bool lHeaterOn = false;
bool CCon = false;
bool lCCon = false;
FILE *hfile; // history file
FIL efile; // external usb file
FRESULT efr; // external file access flags
unsigned int bytesRW;
char fileName[35] = "";
char writeBuffer[maxBufLen][13] __attribute__ ((section("AHBSRAM1"))); // buffer for USB write
char indexLastMsg[0x800]={0}; // index table for last message
CANMessage lastMsg[100]; // table to store last message of eachtype
unsigned char battData[BatDataBufMax]={0}; // 7 * 0x3D = BatDataBufMax
unsigned char msgChanged[100]; // inidcates which bytes changed
char c;
volatile int writePointer = 0;
int readPointer=0;
volatile unsigned short secsNoCarCanMsg = canTimeout;
volatile unsigned short secsNoEvCanMsg = canTimeout;
volatile unsigned short secsNoTouch = 0;
volatile bool carCanIdle,evCanIdle,userIdle;
bool touched=false; //flag to read touchscreen
unsigned char whichTouched = 0;
char counter = 0;
unsigned char dMode[2] = {mainScreen,brakeScreen}; //display mode
unsigned char sMode = 0; // setup mode
unsigned char lastDMode[2] = {0,0}; //last screen mode
unsigned char dtMode = 0;
char displayLog[20][40];
unsigned char displayLoc = 0;
unsigned int fwCount=1;
unsigned char indexOffset = 1;
bool showCP = false;
bool logCP = false; //Turbo3
bool logOnce = false;
bool repeatPoll = true;
bool headlights = false;
bool miles_kmbar = true;
bool tick = false;
bool ZeroSecTick = false;
float ledHi = 0.8; // Bright LED value (until config file read)
float ledLo = 0.1; // Dim LED value (until config file read)
unsigned short pollInt = 300; // polling interval=5 minutes (until config file read)
bool accOn = false; // Accessories on
bool laccOn = false;
float scale12V = 16.2; // R1:R2 ratio
float kWperGid = 0.080;
unsigned short startGids = 0; // Gids at start of trip
unsigned short dailyGids = 0; // Gids per day
bool getGids = false;
signed long mWs_x4 = 0;
unsigned short numWsamples = 0;
unsigned short numSsamples = 0;
float accV = 0;
float accV2 = 0;
float CCkW = 0;
bool playbackEn = false;
bool playbackOpen = false;
//float playbackInt = 0.05; //read messages every 50 ms
float playbackInt = 0.005; //read messages every 5 ms
bool step = false;
char header[5];
char data[8];
signed long motorRPM;
unsigned char skin = ttSkin ;
unsigned char dtePeriod = 14; //ten minute averaging interval
float CCkWh_trip[4]={0};
float kWh_trip[4]={0};
float miles_trip[4]={0};
float curEff = 0;
float maxTripEff = 0;
float minTripEff = 5;
float maxTripMiles = 0;
float maxTripkWh = 1;
float maxTripCCkWh = 0;
float minTripMiles = 5;
float minTripkWh = 1;
float minTripCCkWh = 0;
float mph[39]={0};
float kW[39]={0};
float mpkWh[39]={0};
float mpkWh_noCC=0;
float unloadedV_x2,Resr,curRmax,curRmin,redRmax,redRmin,incRmax,incRmin;
signed short Imax, Imin;
// Logarithmic division scale (roughly - snapped to common units of time)
float timeConstant[39] = {1, 1.58, 2.51, 3.98, 6.31, 10, 15.8, 25.1, 39.8, 60, // 1 minute
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
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
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
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
bool tock = false;
unsigned short pointerSep;
unsigned char reqMsgCnt = 99;
unsigned long Ah_x10000 = 0;
unsigned long SOC_x10000 = 0;
unsigned short SOH2_x100 = 0;
float maxTemp = 0;
bool metric = false;
bool shunt[96]={0};
bool charging=false;
bool showHealth=false;
unsigned char saveDmode[2] = {99, 99};
bool moving=false;
unsigned short chirpInt;
unsigned short uMsgId[8] = {0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000}; // messages to display on debug screen msgId:byte
unsigned short modelYear = 2011;
bool idir, lidir;
bool enableSound=false;
bool clearTest=true;
unsigned long tbScalar = 72464;
unsigned long rbScalar = 8696;
unsigned long fbScalar = 132;
int effCheckTime = 3;
bool ignoreDayData = true;
unsigned short cgids,lgids=0;
unsigned short whpg[300]={0};
float wh[300];
float maxWhpg,minWh,whOff;
int main() {
char sTemp[40];
unsigned long secs;
unsigned short i,j;
unsigned char display=0,lwt=0;
point lastTouch;
float average;
tt.set_orientation(1);
tt.background(Black);
tt.set_display(2); // select both displays
tt.cls();
tt.foreground(White);
tt.set_font((unsigned char*) Arial12x12_prop); // select the font
tt.locate(0,0);
tt.claim(stdout); // send stdout to the TFT display
if(tt.is_touched()){ // If touching screen on poweron then update firmware
updateFirmware();
}
touchpad.rise(&touch_ISR);
tt.wfi(); // enable interrupt on touch
dled.period(0.001);
dled = ledHi; // turn on display LED 80%
spkr = 0;
Resr = 0.075; // initial guess of Resr
timer.start() ;
RTC_Init(); // start the RTC Interrupts that sync the timer
struct tm t,lt; // pointer to a static tm structure
NVIC_SetPriority(CAN_IRQn, 2); //set can priority just below RTC
NVIC_SetPriority(TIMER3_IRQn, 3); //set ticker priority just below can
seconds = time(NULL);
t = *localtime(&seconds);
lt = t; // initialize
// is it a date before 2012 ?
if ((t.tm_year + 1900) < 2012 ) {
// before 2013 so update year to make date entry easier
t.tm_year = 2013 - 1900;
// set the RTC
set_time(mktime(&t));
seconds = time(NULL);
}
t = *localtime(&seconds) ;
strftime(sTemp, 32, "%a %m/%d/%Y %X\n", &t);
printMsg(sTemp); // record RTC
// revision
sprintf(sTemp,"CANary firmware rev%s\n", revStr); // gg - for Logging the revision
printMsg(sTemp); // revision
for(i=0;i<300;i++){ // initialize wh lookup
wh[i]=i*kWperGid*1000;
}
//read efficiency history data
hfile = fopen("/local/ehist.cny", "r");
if (hfile!=NULL){ // found a efficiency history file
for(i=0;i<39;i++){
if(!feof(hfile)){
fscanf(hfile,"%f %f\r\n",&mph[i],&kW[i]);
mpkWh[i]=mph[i]/kW[i];
if(i==dtePeriod) mpkWh_noCC=mpkWh[i];
}
}
if(!feof(hfile)){
fscanf(hfile,"%f %f\r\n",&maxTripEff,&minTripEff);
}
if(!feof(hfile)){
fscanf(hfile,"%f\r\n",&Resr);
}
if(!feof(hfile)){
fscanf(hfile,"%f %f\r\n",&maxTripMiles,&minTripMiles);
}
if(!feof(hfile)){
fscanf(hfile,"%f %f\r\n",&maxTripkWh,&minTripkWh);
}
if(!feof(hfile)){
fscanf(hfile,"%f %f\r\n",&maxTripCCkWh,&minTripCCkWh);
}
for(i=0;i<300;i++){
if(feof(hfile)) break;
fscanf(hfile,"%f\r\n",&wh[i]);
}
fclose(hfile);
printMsg("History Loaded.\n"); // History loaded
} else { // create initial file
printMsg("History not found. Created.\n"); // history not found, created
for(i=0;i<39;i++){
// Pre-load with 4 mpkWh @ 40 mph
mph[i]=40*timeConstant[i];
kW[i]=10*timeConstant[i];
mpkWh[i]=4;
}
}
// Read config file
readConfig();
if (brakeMon){
geiger.attach(&chirp,0.02);
}
if (repeatPoll) { // enable autopolling if enabled
autoPoll.attach(&autoPollISR,pollInt);
}
// Start monitors
can1.monitor(true); // set to snoop mode
can2.monitor(true); // set to snoop mode
can1.frequency(500000);
can2.frequency(500000);
can1SleepMode = VP230Sleep; // Turn on Monitor_only Mode
can2SleepMode = VP230Sleep; // Turn on Monitor_only Mode
can1.attach(&recieve1);
can2.attach(&recieve2);
touched=false;
secsNoTouch=2;
while (true) {
if (!logOpen) { // Open new file if one is not already open
if(logEn&&usbEn){ //logging enabled and USB device detected
strftime(fileName, 32, "%m%d%H%M.alc", &t); //mmddhhmm.alc
efr = f_open(&efile,fileName,FA_WRITE|FA_OPEN_ALWAYS);
seconds = time(NULL);
t = *localtime(&seconds) ;
lastDMode[0]=99;//force refresh
lastDMode[1]=99;//force refresh
if(efr != FR_OK){
sprintf(sTemp,"\nERR:%d Unable to open %s\n\n\n\n",efr,fileName);
printMsg(sTemp); // cannot open alc file
logEn=false;
beep(1000,0.25);
wait_ms(500);
beep(1000,0.25);
} else {
logOpen = true;
readPointer=writePointer;
sprintf(sTemp,"Starting Can Log %s\n",fileName);
printMsg(sTemp); // starting alc log file
logTS(); // Date Time at start
logEvent("Starting"); // Log startup msg for testing
sprintf(sTemp,"Cr%s",revStr);
logEvent(sTemp); // gg - log firmware version
beep(2000,0.25);
}
}//logging enabled and USB detected
} else { // if (logOpen)
pointerSep=(writePointer+maxBufLen-readPointer)%maxBufLen;
if (pointerSep>(maxBufLen/16)||carCanIdle||!logEn) {
// Dump buffer if > 1/16 full or canbus has stopped
if (efr != FR_OK) {
logOpen = false;
printMsg("Failed to append log file.\n"); // failed to append
beep(3000,0.25);
beep(1500,0.25);
beep(750,0.25);
beep(375,0.25);
logEn=false;
} else {
while (readPointer != writePointer) {
efr=f_write(&efile,&writeBuffer[readPointer][0],13,&bytesRW);
if(++readPointer >= maxBufLen){
readPointer=0;
led4 = !led4;
}
}
}
} // if > 1/16 full, canbus has stopped, or logging stopped
if (!logEn) {
sprintf(sTemp,"Stopping Can Log %s\n",fileName);
printMsg(sTemp); // stopping alc log file
f_close(&efile);
logOpen=false;
pointerSep=0;
led4=false;
}
} // if logOpen
if (carCanIdle && (evCanIdle || !logOpen) && userIdle && !playbackEn) { // canbus idle --> sleep to save power
if (repeatPoll) { // stop autopolling if enabled
autoPoll.detach();
}
if (logOpen){ //close file to dump buffer
f_close(&efile);
} else { //detach EVcan so only carcan will trigger wake
can1.attach(NULL);
}// if (logOpen)
seconds = time(NULL);
t = *localtime(&seconds) ;
strftime(sTemp, 40, "Sleeping: %a %m/%d/%Y %X\n", &t);
printMsg(sTemp); // sleeping date time
updateDisplay(0); //Added for turbo3 who has a display override and wants to see the sleep message before going to sleep
updateDisplay(1);
//LPC_RTC->CIIR=0x00; // block RTC interrupts
led1=0;
led2=0;
led3=0;
led4=0;
dled=0; // turn off display
secs = time(NULL); // seconds past 12:00:00 AM 1 Jan 1900
while (secsNoCarCanMsg>canTimeout && (secsNoEvCanMsg>canTimeout || !logOpen) && !touched) {
//DeepPowerDown();
tt.wfi(); //enable touch interrupt
//__wfi(); // freeze CPU and wait for interrupt (from canbus or touch)
Sleep();
}
if (!logOpen){ // Re-attach EVcan
can1.attach(&recieve1);
}
secsNoTouch=2;
carCanIdle=secsNoCarCanMsg>canTimeout;
evCanIdle=secsNoEvCanMsg>canTimeout;
dled=ledHi; // turn on display LED
seconds = time(NULL);
t = *localtime(&seconds) ;
strftime(sTemp, 40, "Waking: %a %m/%d/%Y %X\n", &t);
printMsg(sTemp); // wakeup date time
if (time(NULL)>(secs+1800)) {
if (logOpen){
f_close(&efile);
logOpen = false; // Start new file if asleep for more than 30 minutes
} // if (logOpen)
if (secsNoTouch>100) secsNoTouch = 100; // also mostly reset user Idle counter
} else if (logOpen){ // insert timestamp on each wake if logging enabled (disabled for now)
efr = f_open(&efile,fileName,FA_WRITE|FA_OPEN_ALWAYS);
f_lseek(&efile,0xffffffff); // goto end of file (append existing)
logEvent("WakingUp"); // gg - use messeges
logTS(); // Date-Time at wakeup
}
if (repeatPoll) { // re-enable autopolling if enabled
autoPoll.attach(&autoPollISR,pollInt);
}
wait5secs=5; // Refresh screen after 5 seconds
} // if idle
if(touched){ // call touchscreen procedure if touch interrupt detected
lastTouch = tt.get_touch();
lastTouch = tt.to_pixel(lastTouch); // convert to pixel pos
if((lastTouch.x!=639)&&(lastTouch.x!=319)&&(lastTouch.y!=239)){ // filter phantom touches
if (userIdle) {
secsNoTouch=2; // Ignore first touch if user idle
userIdle=false;
} else {
secsNoTouch=0;
}
if (lastTouch.x>320){
whichTouched=1;
} else {
whichTouched=0;
}
if (whichTouched!=lwt){
lastDMode[lwt]=99; // Repaint lastTouched
lwt=whichTouched;
}
sMode = 1;
}
//sprintf(sTemp,"%d,%d ",lastTouch.x,lastTouch.y);
//printMsg(sTemp); // touch x,y - for debug
touched = false; // clear interrupt flag
}
//---------------
// gg - 4x4 touch
//unsigned char tScrn = 0 ; // screen 0
unsigned char tCol ;
unsigned char tRow ;
if (!userIdle) {
if (secsNoTouch<2) {// Recently touched
secsNoTouch +=2; // increment to prevent double touch
sMode = 1;
//sprintf(sTemp,"button %d %d,%d %d\n",i,buttonX(lastTouch.x,3),buttonY(lastTouch.y,3),lastTouch.x);
//printMsg(sTemp); // button parms - for debug
switch (sMode) {
case 0: // no select
break;
case 1: // select screen
//--------------
// gg - 4x4 touch
tCol = buttonX(lastTouch.x,4) ;
if( tCol >= 4 ){ tCol -= 4; } // touch is on screen 1
tRow = buttonY(lastTouch.y,4) ;
highlightButton( tCol,tRow, whichTouched, 4,4) ; // gg - highlight
if( tRow == tNavRow ) tRow = 7 ; // gg
switch ( (tCol*10) + tRow ) {
//---------------------------------
case 00: // top row, left button on screen 0 or 1
if (dMode[whichTouched]==monitorScreen||dMode[whichTouched]==changedScreen) {
indexOffset=indexOffset>4?indexOffset-4:1;
} else if (dMode[whichTouched] == indexScreen) { // gg - index
dMode[whichTouched] = mainScreen ; // GoTo Main Screen
sMode=0;
} else if (dMode[whichTouched]==config2Screen) {
wait_ms(500);
tt.background(Black);
tt.calibrate();
} else if (dMode[whichTouched]==playbackScreen) { // slower
playbackInt *=2;
if(playbackEn){
playback.detach();
playback.attach(&playbackISR,playbackInt);
}
} else {
lastDMode[whichTouched]=99;//repaint to clear highlight
}
break;
//-----------------------------------------------
case 10: // 1,0 (col left of center,top row) on screen 0 or 1
if (dMode[whichTouched]==changedScreen) {
for(j=0;j<100;j++) msgChanged[j]=0; // clear changed data
lastDMode[whichTouched]=99;//force refresh
sMode=0;
} else if (dMode[whichTouched] == indexScreen) { // gg - index
sMode=0;
dMode[whichTouched] = brakeScreen ; // GoTo Brake Screen
} else if (dMode[whichTouched]==cpScreen) {
reqMsgCnt=0;
msgReq.attach(&sendReq,0.015);
} else if (dMode[whichTouched]==cpHistScreen) { // gg - hist
reqMsgCnt=0;
msgReq.attach(&sendReq,0.015);
} else if (dMode[whichTouched]==cpBarScreen) { // gg - cpbars
reqMsgCnt=0;
msgReq.attach(&sendReq,0.015);
} else if (dMode[whichTouched]==configScreen) {
mbed_reset();
} else if (dMode[whichTouched]==config2Screen) { // reset DTE Max/Min
maxTripEff = 0;
minTripEff = 5;
beep(2000,0.25);
for(i=0;i<300;i++){ // initialize wh lookup
wh[i]=i*kWperGid*1000;
}
} else if (dMode[whichTouched]==playbackScreen) { // pause/unpause
playbackEn=!playbackEn;
if(playbackEn){
playback.attach(&playbackISR,playbackInt);
} else {
playback.detach();
}
} else {
lastDMode[whichTouched]=99;//repaint to clear highlight
}
break;
//--------------------------------------
case 20: // col 2 and row 0 on either screen 0 or 1
if (dMode[whichTouched]==monitorScreen||dMode[whichTouched]==changedScreen) {
indexOffset=indexOffset<77?indexOffset+4:80;
} else if (dMode[whichTouched] == indexScreen) { // gg - index
dMode[whichTouched] = effScreen ; // GoTo EFF Screen
sMode=0;
} else if (dMode[whichTouched]==configScreen) {
dMode[whichTouched]=mainScreen;
//write efficiency history data
hfile = fopen("/local/ehist.cny", "w");
if (hfile!=NULL){ // found a efficiency history file
for(i=0;i<39;i++){
fprintf(hfile,"%f %f\r\n",mph[i],kW[i]);
}
fprintf(hfile,"%f %f\r\n",maxTripEff,minTripEff); // Save max and min
fprintf(hfile,"%f \r\n",Resr); // Save series resistance
fprintf(hfile,"%f %f\r\n",maxTripMiles,minTripMiles); // Save max and min
fprintf(hfile,"%f %f\r\n",maxTripkWh,minTripkWh); // Save max and min
fprintf(hfile,"%f %f\r\n",maxTripCCkWh,minTripCCkWh); // Save max and min
for(i=0;i<300;i++){
fprintf(hfile,"%f\r\n",wh[i]);
}
fclose(hfile);
}
beep(2000,0.25);
saveConfig();
beep(2000,0.25);
} else if (dMode[whichTouched]==config2Screen) {
showHealth = !showHealth;
} else if (dMode[whichTouched]==playbackScreen) { // faster
if(playbackInt>.002){
playbackInt/=2;
if(playbackEn){
playback.detach();
playback.attach(&playbackISR,playbackInt);
}
}
} else {
lastDMode[whichTouched]=99;//repaint to clear highlight
}
break;
case 30: // right-most on top row
if (dMode[whichTouched]==config2Screen) {
// step through skins
if( skin < maxSkin ) skin += 1 ;
else skin = 0 ;
// repaint both screens, I think
lastDMode[whichTouched]=99;//repaint to clear highlight
// and re-paint the other screen too, to see new skin there
lastDMode[whichTouched ^ 1]=99; // repaint other screen (^ = XOR)
} else if (dMode[whichTouched] == indexScreen) { // gg - index
dMode[whichTouched] = healthScreen ; // Goto health screen
sMode=0;
} else if (dMode[whichTouched] == testScreen) { // gg -
clearTest=true;
} else { // top-right corner always mute/unmute unless used by specific screen
enableSound = !enableSound;
if(!enableSound) spkr=0;
}
break;
//----------------------------------
//----------------------------------
case 01: // left col middle row
if (dMode[whichTouched]==configScreen) {
logEn = !logEn;
} else if (dMode[whichTouched] == indexScreen) { // gg - index
dMode[whichTouched] = cpScreen ; // GoTo CP Data Screen
sMode=0;
} else if (dMode[whichTouched]==dateScreen){
dtMode=(dtMode<5)?dtMode+1:0;
lastDMode[whichTouched]=99;
} else {
lastDMode[whichTouched]=99;//repaint to clear highlight
}
break;
//------------------------------
case 11:
if (dMode[whichTouched]==configScreen){
repeatPoll = !repeatPoll;
if (repeatPoll) {
autoPoll.attach(&autoPollISR,pollInt);
} else {
autoPoll.detach();
}
} else if (dMode[whichTouched] == indexScreen) { // gg - index
dMode[whichTouched] = cpHistScreen ; // GoTo CP Hist Screen
sMode=0;
} else if (dMode[whichTouched]==playbackScreen) {
// Start/stop playback
if(!playbackOpen){
if(!carCanIdle){
printMsg("Cannot playback while connected to canbus\n");
}else if(!logOpen){
efr = f_open(&efile,"playback.alc",FA_READ|FA_OPEN_EXISTING);
lastDMode[whichTouched]=99;//force refresh
if(efr != FR_OK){
printMsg("Unable to open /usb/playback.alc\n"); // no playback.alc
beep(1000,0.25);
} else {
playbackOpen = true;
playbackEn=true;
playback.attach(&playbackISR,playbackInt);
printMsg("Starting playback\n"); // start playback
beep(2000,0.25);
can1.attach(NULL);// Stop recieving EVCAN data
can2.attach(NULL);// Stop recieving CARCAN data
}
} else {
printMsg("Must stop logging first\n");
}
} else {
playback.detach();
f_close(&efile);
playbackOpen=false;
playbackEn=false;
can1.attach(&recieve1);// Restore EVCAN data recieve
can2.attach(&recieve2);// Restore EVCAN data recieve
lastDMode[whichTouched]=99;
}
} else if (dMode[whichTouched]==dateScreen){
upDate(dtMode,true);
lastDMode[whichTouched]=99;
} else {
lastDMode[whichTouched]=99;//repaint to clear highlight
}
break;
//---------------------------------
case 21: // col 2 row 1
if (dMode[whichTouched]==configScreen) { // gg - Batt Log Enable Button
yesBattLog = !yesBattLog;
} else if (dMode[whichTouched] == indexScreen) { // gg - index
dMode[whichTouched] = cpBarScreen ; // GoTo CP Bars Screen
sMode=0;
} else if (dMode[whichTouched]==dateScreen){
upDate(dtMode,false);
lastDMode[whichTouched]=99;
} else {
lastDMode[whichTouched]=99;//repaint to clear highlight
}
break;
case 31: // col 3 row 1
if (dMode[whichTouched]==config2Screen) { // gg - Batt Log Enable Button
debugMode = !debugMode;
} else if (dMode[whichTouched] == indexScreen) { // gg - index
dMode[whichTouched] = configScreen ; // GoTo Config Screen
} else if (dMode[whichTouched]==tripScreen) { // Cancel day trip meter
ignoreDayData=true;
lastDMode[whichTouched]=99;//repaint to clear highlight
} else if ((dMode[whichTouched]==dateScreen)&&accOn){
syncDone=false; // initiate clock sync
lastDMode[whichTouched]=99;
} else {
lastDMode[whichTouched]=99;//repaint to clear highlight
}
break;
//-----------------------------------
case 02: // left col, bottom row (not nav)
if (dMode[whichTouched] == indexScreen) { // gg - index
dMode[whichTouched] = playbackScreen ; // GoTo Playback Screen
} else if (dMode[whichTouched]==configScreen) {
brakeMon = !brakeMon;
if(brakeMon){
geiger.attach(&chirp,0.02);
}else{
geiger.detach();
}
} else if (dMode[whichTouched]==config2Screen) {
autoSync = !autoSync;
} else {
lastDMode[whichTouched]=99;//repaint to clear highlight
}
break;
case 12: // left-middle col, bottom row (not nav)
if (dMode[whichTouched]==configScreen) {
regenMon = !regenMon;
} else if (dMode[whichTouched]==config2Screen) { // gg - index
dMode[whichTouched] = dateScreen ; // GoTo Set Date/Time Screen
} else {
lastDMode[whichTouched]=99;//repaint to clear highlight
}
break;
case 22: // right-middle col, bottom row (not nav)
if (dMode[whichTouched]==indexScreen) { // gg - index
dMode[whichTouched] = logScreen ;
sMode=0;
} else if (dMode[whichTouched]==configScreen) {
heaterMon = !heaterMon;
} else if (dMode[whichTouched]==config2Screen) {
updateConfig();
lastDMode[whichTouched]=99;//force refresh
sMode=0;
} else {
lastDMode[whichTouched]=99;//repaint to clear highlight
}
break;
case 32: // right col, bottom row (not nav)
if (dMode[whichTouched]==config2Screen) {
logEn=false;
updateFirmware();
} else if (dMode[whichTouched]==tripScreen) {
// Reset custom trip meter
miles_trip[2]=0;
kWh_trip[2]=0;
CCkWh_trip[2]=0;
sMode=0;
lastDMode[whichTouched]=99;//repaint to clear highlight
} else if (dMode[whichTouched]==indexScreen) {
dMode[whichTouched] = tripScreen ;
sMode=0;
} else if (dMode[whichTouched]==dateScreen){
autoSync=!autoSync; // toggle autoSync mode
lastDMode[whichTouched]=99;
} else {
lastDMode[whichTouched]=99;//repaint to clear highlight
}
break;
//-----------------------------------
//-----------------------------------
// Prev Navigation
case 07: // col 0 row tNavRow
dMode[whichTouched]=dMode[whichTouched]>0?dMode[whichTouched]-1:maxScreens;
break;
//-----------------------------------
// Select Screen Navigation
case 17:
sMode=0;
lastDMode[whichTouched]=99; // Repaint
break;
//-----------------------------------
// Index Navigation
case 27: // col 2 row tNavRow
dMode[whichTouched]= indexScreen ; // gg - index
break;
//------------------------------------
// Next Navigation
case 37: // lower right on Nav Line gg - move next
dMode[whichTouched]=dMode[whichTouched]<maxScreens?dMode[whichTouched]+1:0;
break;
//------------------------------------
//------------------------------------
default:
lastDMode[whichTouched]=99;//repaint to clear highlight
break;
}
break;
case 2: // numpad
break;
case 3:
break;
default:
break;
} // case sMode
} //recently touched
} else { // userIdle
if(sMode==1){
sMode=0;
lastDMode[whichTouched]=99;
}
}
// Sound tone on power reversal
idir=(kW[0]>0)?true:false;
if(regenMon){
if (idir&&!lidir){
beep(800,0.02); // Started sinking current
}else if(!idir&&lidir){
beep(3200,0.02); // Started regen
}
}
lidir=idir;
if(tick){ // Executes once a second
tick=false;
lCCon = CCon;
CCkW = (lastMsg[indexLastMsg[0x510]].data[3]&0x7f)*0.125;
if(lastMsg[indexLastMsg[0x510]].data[3]&0x80){
CCon=true; // On when button pushed
} else if(CCkW==0) {
CCon=false; // Off when power drops back to zero
}
if(!CCon && lCCon){
lastDMode[0]=99;//force refresh
lastDMode[1]=99;//force refresh
}
headlights = (lastMsg[indexLastMsg[0x358]].data[1]&0x80)?true:false; // headlight/turn signal indicator
if(heaterOn){
lHeaterOn=true; // Only indicate heater once per power cycle
}
heaterOn =((lastMsg[indexLastMsg[0x54f]].data[5]&0x3f)>2)?true:false;
if(heaterMon && heaterOn && !lHeaterOn){ //Heat on alarm
beep3(800,0.25,1200,0.25,1600,0.25);
//beep(1600,0.5);
}
if(accOn&&indexLastMsg[0x355]>0){
miles_kmbar = (lastMsg[indexLastMsg[0x355]].data[4]&0x20)?true:false; // indicates selected distance units
metric = !miles_kmbar;
}
accV=floor(mon12V*scale12V*10+0.5)/10; //Round to nearest 10th
accOn=(playbackOpen||(accV>5))?true:false;
moving=(mph[0]>0.1);
charging=(lastMsg[indexLastMsg[0x5bf]].data[2]>0)?true:false; // FF when charging
if (laccOn&&!accOn){ // Car turned off
dailyGids += startGids-((lastMsg[indexLastMsg[0x5bc]].data[0]<<2)+(lastMsg[indexLastMsg[0x5bc]].data[1]>>6));
lHeaterOn=false;
if (showHealth&&!playbackOpen){
if (saveDmode[0]==99){
saveDmode[0]=dMode[0];
saveDmode[1]=dMode[1];
}
dMode[0]=healthScreen;
dMode[1]=tripScreen;
secsNoTouch=2;// Keep display on a few seconds
sMode=0;
userIdle=false;
}
if (repeatPoll) { // Log on shutdown if autopoll enabled
tripLog(); // Write trip log on powerdown
}
//write efficiency history data
hfile = fopen("/local/ehist.cny", "w");
if (hfile!=NULL){ // found a efficiency history file
for(i=0;i<39;i++){
fprintf(hfile,"%f %f\r\n",mph[i],kW[i]);
}
fprintf(hfile,"%f %f\r\n",maxTripEff,minTripEff); // Save max and min
fprintf(hfile,"%f \r\n",Resr); // Save series resistance
fprintf(hfile,"%f %f\r\n",maxTripMiles,minTripMiles); // Save max and min
fprintf(hfile,"%f %f\r\n",maxTripkWh,minTripkWh); // Save max and min
fprintf(hfile,"%f %f\r\n",maxTripCCkWh,minTripCCkWh); // Save max and min
for(i=0;i<300;i++){
fprintf(hfile,"%f\r\n",wh[i]);
}
fclose(hfile);
}
}
if (!laccOn&&accOn){ // Car turned on
lHeaterOn=false;
getGids=true;
miles_trip[0]=0;
kWh_trip[0]=0;
CCkWh_trip[0]=0;
seconds = time(NULL);
t = *localtime(&seconds);
if(miles_trip[1]<1){ // charged since last trip
// Adjust wh lookup with whpg data
maxWhpg=0;
minWh=0;
whOff=0;
for(i=1;i<300;i++){
if(whpg[i]>maxWhpg){ //Find maxWhpg and associated Wh
maxWhpg = (float) whpg[i];
minWh = wh[i];
if(debugMode){
sprintf(sTemp,"maxWhpg=%3.1f; minWh=%3.1f\n", maxWhpg, minWh);
printMsg(sTemp);
}
}
if(whpg[i]>0){ // Compute adjustment to measured range
whOff = (maxWhpg-(float)whpg[i])-(wh[i]-minWh);
}else if(whpg[i-1]>0){ // Compute final offset for rest of range
whOff = maxWhpg-(wh[i]-minWh);
if(debugMode){
sprintf(sTemp,"whOff=%3.1f\n", whOff);
printMsg(sTemp);
}
}
wh[i] += 0.1*whOff; // Add offset; use last known good offset when no data
whpg[i-1]=0;
}
whpg[299]=0;
// Check and reset daily efficiency if charged since last trip and at least 24 hours has past
if((t.tm_yday>lt.tm_yday)&&(t.tm_hour>effCheckTime)){
if (!ignoreDayData&&(miles_trip[3]>15)){ // Ignore low mileage data
curEff = miles_trip[3]/kWh_trip[3]; // Get current daily efficiency
if (maxTripEff<curEff) {
maxTripEff=curEff;
maxTripMiles=miles_trip[3];
maxTripkWh=kWh_trip[3];
maxTripCCkWh=CCkWh_trip[3];
printMsg("New max efficiency.\n");
}
if (minTripEff>curEff) {
minTripEff=curEff;
minTripMiles=miles_trip[3];
minTripkWh=kWh_trip[3];
minTripCCkWh=CCkWh_trip[3];
printMsg("New min efficiency.\n");
}
}
// Clear daily efficiency data
dailyGids=0;
miles_trip[3]=0;
kWh_trip[3]=0;
CCkWh_trip[3]=0;
ignoreDayData=false;
lt=t; // Remember when counters were cleared (start time for new data)
}
} // Charged since last trip
wait5secs=5;
if (showHealth&&!playbackOpen){
if (saveDmode[0]==99){
saveDmode[0]=dMode[0];
}
dMode[0]=healthScreen;
}
syncDone=!autoSync; // clear syncDone flag if autoSync enabled
} // Car turned on
laccOn=accOn;
if(!accOn&&userIdle&&!playbackEn){ // Car off and no user activity - turn off screen
dled = 0;
if (saveDmode[0]<99){
dMode[0]=saveDmode[0];
saveDmode[0]=99;
}
if (saveDmode[1]<99){
dMode[1]=saveDmode[1];
saveDmode[1]=99;
}
}else if(!headlights){
dled = ledHi;
} else {
dled = ledLo;
}
cgids=(lastMsg[indexLastMsg[0x5bc]].data[0]<<2)+(lastMsg[indexLastMsg[0x5bc]].data[1]>>6);
if(getGids){
startGids=cgids; //Get gids
if((startGids>0)&&(startGids<300)){ // Ignore bogus values at startup
getGids=false;
lgids=startGids; // initialize wh/gid array
}
}
if((cgids>0)&&(cgids<300)){
if(cgids!=lgids){
if((kWh_trip[1]+CCkWh_trip[1])>0){
whpg[cgids] = (unsigned short) (1000*(kWh_trip[1]+CCkWh_trip[1])); // Save kWh for each gid since last charge
}else{
whpg[cgids] = 0;
}
lgids=cgids;
}
}
if(wait5secs>0){ // Wait a few seconds after poweron to give BMS time to measure CP's
wait5secs-=1;
if(wait5secs==0){
if (repeatPoll) { // Poll on startup if autopoll enabled
logOnce=true;
reqMsgCnt=0;
msgReq.attach(&sendReq,0.015);
lastDMode[0]=99;
lastDMode[1]=99;
}
}
}
//remove health screen once moving
if(moving&&(saveDmode[0]<99)&&(wait5secs==0)){
dMode[0]=saveDmode[0];
saveDmode[0]=99;
}
//compute historic efficiency
if(numSsamples>0){ // Avoid div0
// calibrated to dash mph which reads slightly fast.
// 227 would give more accurate mph for MXV4s@40psi - 11.75" distance from center of tire to pavement
// but then efficiency estimation would not track miles driven as read from the odometer so
// making CANary have the same error as the Leaf instrumentation
mph[0]=((float) motorRPM)/numSsamples/110;
} else {
mph[0]=0;
}
if(mph[0]>99){
mph[0]=0;
}
numSsamples=0;
if(numWsamples>0){ // Avoid div0
mpkWh[0]=mph[0];
kW[0]=((float) mWs_x4)/numWsamples/4e3;
mpkWh[0]/=kW[0];
if (mpkWh[0]<0) {
mpkWh[0]=99;// negative means inf.
}
kW[0]-=CCkW; // subtract climate control power from recorded value
} else {
kW[0]=0;
mpkWh[0]=0;
}
numWsamples=0;
if(accOn&&!charging){ // Calculate averages
for(i=1;i<39;i++){
average=mph[i]/timeConstant[i];
mph[i]-=average;
mph[i]+=mph[0];
mpkWh[i]=average;
average=kW[i]/timeConstant[i];
kW[i]-=average;
kW[i]+=kW[0];
if(i==dtePeriod) mpkWh_noCC=mpkWh[i]/average; // compute efficiency w/o CC for dtePeriod
average+=CCkW; //add climate control power back in for display
mpkWh[i]/=average;
if (mpkWh[i]<0) {
mpkWh[i]=99;// negative means inf.
}
}
}
if (!charging){
miles_trip[0]+=mph[0]/3600; // per trip
miles_trip[1]+=mph[0]/3600; // per charge
miles_trip[2]+=mph[0]/3600; // user
miles_trip[3]+=mph[0]/3600; // per day/roundtrip
kWh_trip[0]+=kW[0]/3600;
kWh_trip[1]+=kW[0]/3600;
kWh_trip[2]+=kW[0]/3600;
kWh_trip[3]+=kW[0]/3600;
CCkWh_trip[0]+=CCkW/3600;
CCkWh_trip[1]+=CCkW/3600;
CCkWh_trip[2]+=CCkW/3600;
CCkWh_trip[3]+=CCkW/3600;
} else { // charging so reset per charge trip meter
miles_trip[1]=0;
kWh_trip[1]=0;
CCkWh_trip[1]=0;
}
motorRPM=0;
mWs_x4=0;
// Compute ESR
if((Imax-Imin)<40){ // do nothing - insufficient delta_I to measure
unloadedV_x2 = (curRmax+curRmin)/2;
}else if ((redRmax-redRmin)<(curRmax-curRmin)) { // less variation on reduced Resr
Resr-=0.001;
unloadedV_x2 = (redRmax+redRmin)/2;
} else if ((incRmax-incRmin)<(curRmax-curRmin)) { // less variation on increased Resr
Resr+=0.001;
unloadedV_x2 = (incRmax+incRmin)/2;
} else { // current Resr is still best answer
unloadedV_x2 = (curRmax+curRmin)/2;
}
curRmin=1000;
curRmax=0;
incRmin=1000;
incRmax=0;
redRmin=1000;
redRmax=0;
Imax=-1000;
Imin=1000;
if(logCP&&usbEn){
if(logOnce){
tripLog();
logOnce=false;
}
logPackVoltages(); // Turbo3, only call
}
if(!usbEn){
usbEn=detectUSB(); // Keep looking if none found
if(usbEn){ // Force update to clear USB init garbage
lastDMode[0]=99;
lastDMode[1]=99;
}
}
if(!syncDone){
syncDone=syncDateTime();
}
tock=true;
} // tick
if(step){ // playback
if(playbackOpen&&playbackEn){
for(i=0;i<120;i++){
if(!f_eof(&efile)){
efr=f_read(&efile,&header,5,&bytesRW);
efr=f_read(&efile,&data,8,&bytesRW);
logCan(header[0],CANMessage(0x7ff&((header[4]<<8)+header[3]), data, 8)); // Playback
} else {
f_close(&efile); // restart
efr = f_open(&efile,"playback.alc",FA_READ|FA_OPEN_EXISTING);
lastDMode[whichTouched]=99;//force refresh
beep(2000,0.25);
}
}
}
step=false;
}
display=display<1?display+1:0; // toggle display
updateDisplay(display);
} //while (true)
}