Homemade. TURBO BOOST / RPM Meter

Code:
#include <Wire.h> 

#include <LiquidCrystal_I2C.h> // 2 wirecumminication width the display

#include <EEPROM.h> //used to store total fuel and total km

LiquidCrystal_I2C lcd(0x27,16,2);  // set the LCD address to 0x27 for a 16 chars and 2 line display





long interval = 1000; //updating display every this numbers millisecond 

int eeprom_10;

float totalL = 0;        //total Liter Fuel used

float kmprL =0;          //instant uses km / Liter

float Lprhr =0;          // Liter fuel / hour

int tps =0;              // Trottle position Sensor in %

int tps_raw =0;          // 0 to 1024 

float tps_gear =0;



float boost =0;            //boost in bar

int boost_raw=0;

int boost_raw_avg=0;       //Boost in raw 0 - 1024 analog read

float boost_max =0;        //MAx Boost in raw 0 - 1024 analog read

float egp =0;              //EGP in Bar Exhaustgas pressure

int egp_raw=0;             //EGP in 0 - 1024 analog read   

int egp_raw_avg=0;         //EGP_avg in 0 - 1024 analog read   

float egp_max =0;          //Max egp in bar

int boost_reg =255;        //this is uset to regulate the wanes in the turbo 0 = fully åben 255 = fully closed

int delta_p_sloope =2;     //  0,1 bar to mutch dif pressure gives PWM=155 (255 is max closing vanes.)

int max_dif_pressure = 75; //100=0,5 bar 50=0,25 bar

int max_boost = 90;       // 90 = 0,9 bar  





//int c =0;                   //temp to analog pin 0



int j =0;                   //testing

int j_2 =0;                 //testing

int dd = 33;



int side=1;

int tid=0;

int secounds =0;

int minuts =0;

int timer =0;



int tester = 134;

int g =0;  

int h =0; 

int kk=0;





//--------------------------------------------------------To control Slow loop-------

long previousMillis = 0;

long previousMillis_2 = 0;



//All we need to-------------------------------------------Display shift button----------

int buttonstate3 = 0;

int lastbuttonstate3 = 0;

int btre =0;



//All we need to-------------------------------------------Km/hr Sensor-------------------

int buttonstate2 = 0;

int lastbuttonstate2 = 0;

long kmcounts =0;

int bto =0;

int deltaTkm =0;

unsigned long kmtid1 =0; //tid 

unsigned long kmtid2 =0; //tid 



int totalkm =0;

float KmCountScale = 5400; //counts pr km

int KmPrHr=10;



//All we need to-------------------------------------------Fuel Sensor---------------------

int fuelsensorscale = 4843; //Fuesflow sensor this sensor gives 4844 counts / liter

int buttonstate = 0;

int lastbuttonstate = 0;

int fuelcounts =0;          //Antal fuel COUNTS

float fuelcounts2 =0;

int b =0; 

float deltaTfuel = 1;       //times between a fuelcount used for Liter / hour

unsigned long d =0;         //tid 

unsigned long e =0;         //tid 



//All we need to count ------------------------------------Turbo RPM------------------------

int buttonstate4 =0;

int lastbuttonstate4 =0;

int turbo_counts =0;

int b_4 =0;

float deltaT_turbo=60000;

unsigned long turbo_t1=0;

unsigned long turbo_t2=0;

long RPM_turbo =0;

long RPM_turbo_max =0;



//All we need to count-------------------------------------Motor RPM------------------------

int buttonstate5 =0;

int lastbuttonstate5 =0;

long rpm_motor =0;

int b_5 =0;

int rpmT_motor=1;

unsigned long rpm_t1=0;

unsigned long rpm_t2=0;

//------------------------------------------------------------------------------------------



int addr = 0; //EEPROM adresse 

int eepromgem =0; //used as a constant, when to save in EEprom



//----disse herunder er midlertidige til speed kontrol

int time_1 = 0;

int time_2 = 0;

int delta_time =0;



void setup()

{

  lcd.init();                      // initialize the lcd 

  lcd.backlight();

  

  pinMode (4,INPUT); //RPM

  pinMode (5,INPUT); //Shift display

  pinMode (6,INPUT); //KM input

  pinMode (7,INPUT); //Turbo RPM

  pinMode (8,INPUT); //ikke i brug skal bruges til fuel

  

 //if (c==0) {EEPROM.write(0,0); EEPROM.write(1,0); } //Slet EEPROM

  fuelcounts = EEPROM.read(0) * 256 + EEPROM.read(1); //TACHO count total fra EEPROM

  kmcounts   = EEPROM.read(2) * 256 + EEPROM.read(3);

  secounds   = EEPROM.read(4);  minuts = EEPROM.read(5); timer = EEPROM.read(6);



  eeprom_10 = EEPROM.read(10) * 256 + EEPROM.read(11);

  digitalWrite(4, LOW); // use internel pullup resistor on shift buttom

  digitalWrite(5, HIGH); // use  internel pullup on page shift

  digitalWrite(6, HIGH); // use  internel pullup resistor on fuel sensor

  digitalWrite(7, HIGH);  // Holset RPM sensor pull down is used

  digitalWrite(8, LOW);  // Brug intern pullup modstand på fuel sensor





  

  //fuelcounts2 = fuelcounts *100;

  lcd.begin(16, 2);

  pinMode(11, OUTPUT);   // sets the pin as output

  pinMode(10, OUTPUT);   // sets the pin as output

}



void loop()

{

      //The next 4 lines counts from the Fuel-sensor inputs

        buttonstate = digitalRead(6); //

        if (buttonstate != lastbuttonstate) { if (buttonstate == HIGH){ fuelcounts2++; b++; } lastbuttonstate = buttonstate; } //digital input fuel Sensor

        if (b==1) {e=d; d = millis(); deltaTfuel=(d-e); b=0;} //tid mellem counts afhængig af b>10 eller 100

        if (deltaTfuel > 1000) {deltaTfuel =1000;}



      //The next 4 lines counts from the  KM-sensor inputs

        buttonstate2 = digitalRead(6); //Digital pin 6 Speed input

        if (buttonstate2 != lastbuttonstate2) { if (buttonstate2 == HIGH){ kmcounts++; bto++; } lastbuttonstate2 = buttonstate2; } 

        if (bto==1) {kmtid2=kmtid1; kmtid1 = millis(); deltaTkm=(kmtid1-kmtid2); bto=0;} //tid between counts afhængig af b>10 eller 100

        if (deltaTkm > 1000) {deltaTkm =1000;}



     //The next 4 lines counts from the  Turbo-RPM-sensor inputs

        buttonstate4 = digitalRead(4); //Digital Pin 7

        if (buttonstate4 != lastbuttonstate4) { if (buttonstate4 == HIGH){ b_4++; } lastbuttonstate4 = buttonstate4; } //digital input RPM TURBO Sensor

        if (b_4==100) {turbo_t2=turbo_t1; turbo_t1 = millis(); deltaT_turbo=(turbo_t1-turbo_t2); b_4=0;} //deltaT_turbo = time between 100 rotation, IF 90909 rpm it is 66 mS

        //if (deltaT_turbo > 1000) {deltaT_turbo =60000;}



     //The next 4 lines counts from the  Motor-RPM-sensor inputs

        buttonstate5 = digitalRead(7); //Read RPM motor on digital pin 5

        if (buttonstate5 != lastbuttonstate5) { if (buttonstate5 == HIGH){ b_5++; } lastbuttonstate5 = buttonstate5; } //Motor RPM Sensor

        if (b_5==100) {rpm_t2=rpm_t1; rpm_t1 = millis(); rpmT_motor=(rpm_t1-rpm_t2); b_5=0;} //time between 100 rotation 

        //if (rpmT_motor > 100) {rpmT_motor =6000;}





       //testing how fast i can run a loop it took 28 mikro secondes  --------------------------To be deleted ------------------------------------------

        //time_1 = micros();

        //delta_time = time_1 - time_2;

        //time_2 = time_1;

                    

//--------------------------------From here on we run a loop every 10 mS------------------------------------------------------------------------------

                unsigned long currentMillis_2 = millis(); if(currentMillis_2 - previousMillis_2 > 10) 

                {

                    previousMillis_2 = currentMillis_2; //Vi opdatere display efter hvad der står i interval  

                  

                  //If pin 5 is triggered i change what to show in the display, change between 5 screens

                    buttonstate3 = digitalRead(5); 

                    if (buttonstate3 != lastbuttonstate3) { if (buttonstate3 == LOW){  btre++; delay(1000);} lastbuttonstate3 = buttonstate3; } //digital input display page

                    if (btre==7) {btre=0;} //if we hit 7 go back to screen side 0

            

                  //TPS in %

                    tps_raw = analogRead(3);                 //reads tps from 0 - 5 V sensor 0 - 1024

                    tps_raw = constrain(tps_raw, 100, 614);  //limits range of sensor values to between 100, 614 messure 0,5 - 3 Volt,  0, 1024 messure from 0 - 5 V specific to my sensor

                    tps = map(tps_raw, 100, 614, 0, 100);    //start 0% at 0,5 V and says 100% at 614 = 3 V  

                                    

                  //Here we read the EGP sensor and conwert it to Bar 1 bar = 15 PSi, (0.5 volt = - 1 bar 4.5 volt = 3 bar )

                    egp_raw_avg = analogRead(1);                       

                    egp_raw = (egp_raw_avg + egp_raw * 10) / 11;       //filter, spikes are supressed

                    egp_raw = constrain(egp_raw, 300, 1024);           // limits range of sensor values to between 0 - 3,5 bar the 307 is = atmosfaric pressure on this sensor

                    egp = map(egp_raw, 300, 1024, 0, 350);             // map the 0 - 1024 input to 0 - 350 milibar  

                    if(egp > egp_max) {egp_max = egp;}                 //Constantly keep track of max pressure

                                          

                  //Here we read the BOOST sensor and conwert it to MiliBar 100 milibar = 15 PSi, (0.5 volt = - 1 bar 4.5 volt = 3 bar )

                    boost_raw_avg = analogRead(2);                     //reads boost 3 Bar 0 Volt = -1,5 bar 5 volt + 3,5 bar

                    boost_raw = (boost_raw_avg + boost_raw * 10) / 11; //filter 

                    boost_raw = constrain(boost_raw, 300, 1024);       // limits range of sensor values to between 0 - 3,5 bar the 307 is = atmosfaric pressure on this sensor

                    boost = map(boost_raw, 300, 1024, 0, 350);         // map the 0 - 1024 input to 0 - 350 milibar  

                    if(boost > boost_max) {boost_max = boost;}

                 

                  //Controlling Delta pressure between EGP and Boost, And Max boost regarding TPS we dont want the EGP to go to higt widthout also Boost rising            

                    if( tps >  0) {max_dif_pressure = 15; }   

                    //if( tps > 10) {max_dif_pressure = 15; max_boost = 60;}   

                    //if( tps > 20) {max_dif_pressure = 20; max_boost = 70;}

                    if( tps > 30) {max_dif_pressure = 35; }

                    //if( tps > 40) {max_dif_pressure = 30; max_boost = 90;}  //if TPS bigger then 40%, max_dif_pressure 40 = 0,20 bar, (Crusing low EGP)

                    //if( tps > 50) {max_dif_pressure = 35; max_boost = 100;}

                    //if( tps > 60) {max_dif_pressure = 40; max_boost = 110;}

                    //if( tps > 70) {max_dif_pressure = 40; max_boost = 130;}

                    //if( tps > 80) {max_dif_pressure = 40; max_boost = 160;}

                    //if( tps > 90) {max_dif_pressure = 40; max_boost = 200;}



                //Differential EGP - BOOST  pressure to high wastegate starts open or VNT opens

                    boost_reg = 255 - (((egp - ( max_dif_pressure + boost ))) * delta_p_sloope) ;   

                                                                          

                //Max boost control. 

                    if (boost > max_boost) {boost_reg = 255- (boost - max_boost)*10 ;  } //254 -(100-90)*10 = boostreg = 150

                    if (boost_reg > 255) {boost_reg =255;}

                    if (boost_reg < 1) {boost_reg =0;}

                  

                //Controlling the vacuum valve on the Turbo

                    analogWrite(11,boost_reg);  //This makes the PWM signal out to pin 11. connectet to the mosfet

                   

                    

                    if(tps_gear > tps) {tps_gear = tps;}           //IF tps is let of tps_gear is lovered also instant.

                    if(tps >tps_gear) {tps_gear = tps_gear + 0.5;}   //If Tps goes quick up the tps gear takes 1 sec to rice, to have a smooth kickdown in the gearbox

        

                 

                    analogWrite(10,(tps_gear + boost/2)); //A PWM signal is put out on pin 10 it add TPS + Boost/2 0 - 255, to give a 0 - 5 Volt This is a prasentation of engine momentum of the engine, a resistor and a condensator is also needet

                                        

                 //Calculation for RPM turbo

                    RPM_turbo = (6000000 / deltaT_turbo) ; // RPM X 1000 = 60 / tid i mS * 100 

                    if(RPM_turbo > RPM_turbo_max) { RPM_turbo_max = RPM_turbo;  }

                    if(RPM_turbo < 0){RPM_turbo = 0;}

                    

                    rpm_motor = (10000 /rpmT_motor)*10;

                    if (rpm_motor > 7000) { rpm_motor = 7000;}

        

                } //Here the 10 mS loop stops

      //---------------------------------------------------slow loop from here on the loop is only run every second or what ---------------------------------------------------------------------------------------------------------  

        unsigned long currentMillis = millis();



        if(currentMillis - previousMillis > interval) {

        previousMillis = currentMillis; //if (h == 0) h = 1; else h = 0; //Vi opdatere display efter hvad der står i interval

       

       //Calculation for fuel usage

            fuelcounts = fuelcounts2/100;

            totalL = fuelcounts2/fuelsensorscale;              // 4844 count on one liter

            Lprhr = (360000 / fuelsensorscale) / deltaTfuel;

            KmPrHr = (3600 / deltaTkm) *(1000 / KmCountScale); //5400 counts pr km   60 km/hr= 1 km på 60 sec = 90 counts pr sec = 11 ms kmCountScale = 5.5

            if(deltaTkm >= 900) {KmPrHr =0;}

            totalkm = (kmcounts/KmCountScale);                 //her skal divideres med et stort tal efter km test

            

            kmprL = KmPrHr/Lprhr;                              //her skal der divideres med speedometer signal.

    

     

            tid++;

            secounds++; 

            if (secounds ==59) {minuts++; secounds =0;}

            if (minuts ==59) {timer++; minuts =0;} 



      //----------------------------------------------------From here on LCD Display relevant------------------------------------------------------------------------- 

       if(btre==0) {  

                    interval = 700;

                    //if (dd != 8) {dd=8; lcd.clear();  lcd.print("TOT:L Km/L  L/hr"); }

                    if (dd != 8) {dd=8; lcd.clear(); } //lcd.print("TPS+B TPS-G  TPS"); }

                    //lcd.setCursor(0, 0);  lcd.print("                ");

                    //lcd.setCursor(0, 1);  lcd.print("                ");

                    //lcd.setCursor(0, 1); lcd.print(totalL);

                    lcd.setCursor(6, 1);  lcd.print(kmprL);  lcd.setCursor(12, 1);  lcd.print(Lprhr);   

                    //lcd.setCursor(0, 1); lcd.print(tps_gear + boost/2); lcd.setCursor(6, 1);  lcd.print(tps_gear);  lcd.setCursor(12, 1);  lcd.print(tps);   

                    //lcd.setCursor(0, 0);  lcd.print("                ");

                    lcd.setCursor(1, 0);  lcd.print(" "); lcd.setCursor(3, 1);  lcd.print(" "); lcd.setCursor(12, 0);  lcd.print(" "); lcd.setCursor(12, 1);  lcd.print(" "); 

                    lcd.setCursor(0, 0); lcd.print(tps); lcd.setCursor(3, 0);  lcd.print(boost_reg); lcd.setCursor(7, 0);  lcd.print(egp_max/100);  lcd.setCursor(12, 0); lcd.print(egp/100);   

                    lcd.setCursor(4, 1);  lcd.print("    "); 

                    lcd.setCursor(0, 1); lcd.print(rpm_motor);      lcd.setCursor(7, 1);  lcd.print(boost_max/100);  lcd.setCursor(12, 1);  lcd.print(boost/100);   

                    

                    //33 244 0.55 0.23

                    //120099 0.55:0.23 

                    //boost_reg

                   } 



       if(btre==1) {

                    interval = 500;

                    if (dd != 9) { dd =9; lcd.clear(); lcd.print("Turbo RPM"); lcd.setCursor(0, 1); lcd.print("Turbo MAX");  }

                    lcd.setCursor(10, 0);  lcd.print("     ");  lcd.setCursor(10, 1);  lcd.print("     ");

                    lcd.setCursor(10, 0);  lcd.print(RPM_turbo);  lcd.setCursor(10, 1);  lcd.print(RPM_turbo_max);

                   }

              

       if(btre==2) {

                    if (dd != 1) { dd =1; lcd.clear(); lcd.print("BOOST"); lcd.setCursor(0, 1); lcd.print("EGP");  }

                    interval = 500;

                    if (boost <=0) {boost =0;  }

                    if (egp <=0) {egp =0;  }

                    lcd.setCursor(6, 0);  lcd.print(boost/100);  lcd.setCursor(6, 1);  lcd.print(egp/100);

                    lcd.setCursor(11, 0);  lcd.print(boost_max/100); lcd.setCursor(11, 1);  lcd.print(egp_max/100); 

                    interval = 500;

                   }

       

       if(btre==3) {

                    interval = 1000;

                    if (dd != 2) {dd =2; lcd.clear(); lcd.print("Km/h"); lcd.setCursor(9, 0); lcd.print("km"); }

                    lcd.setCursor(5, 0);  lcd.print("   "); lcd.setCursor(5, 0); lcd.print(KmPrHr);  

                    lcd.setCursor(12, 0);  lcd.print("   "); lcd.setCursor(12, 0); lcd.print(totalkm); 

                    //lcd.setCursor(0, 1); lcd.print(c);//lcd.print(kmcounts); 

                    //lcd.setCursor(8, 1); lcd.print(timer); lcd.setCursor(10, 1); lcd.print(":");  



                    if(timer <10) {lcd.setCursor(8, 1);  lcd.print("0"); lcd.print(timer); }

                    if(timer >=10) {lcd.setCursor(8, 1);  lcd.print(timer); }

                    if(minuts <10) {lcd.setCursor(10, 1);  lcd.print(":"); lcd.setCursor(11, 1);  lcd.print("0"); lcd.print(minuts); }

                    if(minuts >=10) {lcd.setCursor(10, 1);  lcd.print(":"); lcd.setCursor(11, 1);  lcd.print(minuts); }

                    if(secounds <10) {lcd.setCursor(13, 1);  lcd.print(":"); lcd.setCursor(14, 1);  lcd.print("0"); lcd.print(secounds); }

                    if(secounds >=10) {lcd.setCursor(13, 1);  lcd.print(":"); lcd.setCursor(14, 1);  lcd.print(secounds); }

                  }     

            

       if(btre==4) {

              interval = 1000;

              if (dd != 3) { dd =3; lcd.clear(); lcd.setCursor(0, 0); lcd.print("Km"); lcd.setCursor(4, 0);  lcd.print("Km/L");      lcd.setCursor(9, 0);  lcd.print("L/100km");   }

              lcd.setCursor(0, 1); lcd.print("                "); lcd.setCursor(0, 1); lcd.print(totalkm); lcd.setCursor(4, 1);  lcd.print(totalkm/totalL);  lcd.setCursor(10, 1);  lcd.print(totalL/totalkm*100); }

    

       if(btre==5) {

                   interval = 1000;            

                   if (dd != 5) { dd =5; lcd.clear(); lcd.setCursor(0, 0);  lcd.print("TPS  RPM    KM/h");   }

                   //lcd.clear();

                   lcd.setCursor(0, 1);  lcd.print("                "); 

                   lcd.setCursor(0, 1); lcd.print(tps );lcd.setCursor(2, 1); lcd.print("%");   lcd.setCursor(5, 1);  lcd.print(rpm_motor); lcd.setCursor(12, 1);  lcd.print(KmPrHr); 

                  //lcd.print((char)223);  

                  }

      

    //   if(btre==5) {

    //               if (dd != 6) {dd =6; lcd.clear(); lcd.setCursor(0, 0); lcd.print("Gear  Oil  Inter");   }

    //        lcd.setCursor(0, 1); lcd.print(c); lcd.print((char)223); lcd.setCursor(6, 1);  lcd.print("130"); lcd.print((char)223); lcd.setCursor(11, 1); lcd.print("153"); lcd.print((char)223); 

    //             }



//--------------------------------------------LCD Things ends here----------------------------------------------------------------------------------------

       eepromgem++;  

            if (eepromgem>120) {eepromgem=0; EEPROM.write(0, highByte(fuelcounts)); EEPROM.write(1, lowByte(fuelcounts)); 

                                            EEPROM.write(2, highByte(kmcounts));   EEPROM.write(3, lowByte(kmcounts));

                                            //lcd.setCursor(1, 0); lcd.print("SAVE EEPROM ");

                                            //EEPROM.write(4, highByte(tid));       EEPROM.write(5, lowByte(tid)); 

                                            EEPROM.write(4,(secounds)); EEPROM.write(5,(minuts)); EEPROM.write(6,(timer));

                                          }   

            

            //Erase EEprom RESET When you fill up the tank  

            if (btre<6) {j=0;}

            if (btre==6) {

                          interval = 1000;

                          j++;             

                           lcd.clear();  lcd.setCursor(1, 0); lcd.print("Reset in sec ");  lcd.setCursor(14, 0); lcd.print(11-j);

                           if (j>=3 ) {if (j<4 ){RPM_turbo_max = 0; lcd.clear(); lcd.print("RPM Turbo max RESET");}}                            

                           if (j>=4 ) {if (j<5 ){egp_max = 0; boost_max =0; lcd.clear(); lcd.print("Boost max RESET");}}                            

                           if (j>=6 ) {if (j<7 ){max_boost = 200; lcd.clear(); lcd.print("      :-)");}} 

                           if (j>=12) {

                                       j=0;

                                       kmcounts =0; fuelcounts2=0; tid=0; secounds=0; minuts =0; timer=0;

                                       EEPROM.write(0, highByte(0)); EEPROM.write(1, lowByte(0)); 

                                       EEPROM.write(2, highByte(0)); EEPROM.write(3, lowByte(0)); 

                                       EEPROM.write(4, highByte(0)); EEPROM.write(5, lowByte(0)); 

                                       EEPROM.write(6,0); EEPROM.write(7,0); EEPROM.write(8,0);

                                       kmcounts =0; fuelcounts2=0; tid=0; 

                                       lcd.clear(); lcd.setCursor(0, 0); lcd.print("You data is gone :-) ");

                                       btre=1;  

                                      }

                         } 



             if (btre<7) {j_2=0;}

             if (btre==7) {

                          j_2++;             

                          lcd.clear();  lcd.setCursor(1, 0); lcd.print("SETUP: ");  lcd.setCursor(12, 0); lcd.print(j_2);

                          if (j_2 == 1 )  {

                                          EEPROM.write(10, highByte(eeprom_10)); EEPROM.write(11, lowByte(eeprom_10));               

                                          lcd.setCursor(1, 1); lcd.print("Motor RPM:"); eeprom_10 = EEPROM.read(10) * 256 + EEPROM.read(11); lcd.setCursor(12, 1); lcd.print(eeprom_10);

                                          eeprom_10 = 5; 

                                          }

                           

                           if (j_2 == 2 )  { lcd.setCursor(1, 1); lcd.print("Fuel K:");}

                           if (j_2 == 3 )  { lcd.setCursor(1, 1); lcd.print(btre);}

                           if (j_2 == 4 )  { j_2 = 0;}                        

                          } 

    }    // end slow loop

}        // end fast loop