1 (2023-04-14 02:37:57 отредактировано brat4791)

Тема: Отказ в выводе информации от OBD на дисплеи

Всем привет
может кто в теме случившегося или доводилось с подобным сталкиваться
Скетч залит на мегу 2560 про мини отработал с OLED 1.3″ I2C 128х64 некое время ,пока пытался его подредактировать с выводом режимов спидометр тахометр и режим инфо по данным ТТ
Сначала ни стого сего отказал TCA 9548 наличием питания по портам, переключив на один лед, все работало с ним , но потом отказал выводом информации (данных) сам дисплей рабочий. пытался залить исходник ,но и это не помогло инфо данных не выводит , а Меню 4х дисплеев выводит.
Пропал вывод инфо на лед при чтения данных ,хотя лед диод сигнализирует о прохождении сигнала OBD морганием как на начальном  этапе до оптопары,так и после обработки мегой на лед морганием
может кто сможет подсказать ,исправить

// ToyotaOBD1_Reader
// In order to read the data from the OBD connector, short E1 + TE2. then to read the data connect to VF1.
// Note the data line output is 12V - connecting it directly to one of the arduino pins might damage (proabably) the board
// This is made for diaply with an OLED display using the U8glib - which allow wide range of display types with minor adjusments.
// Many thanks to GadgetFreak for the greate base code for the reasding of the data.
// If you want to use invert line - note the comments on the MY_HIGH and the INPUT_PULLUP in the SETUP void.
////////////////////////////////////////////////////////////////////////////////////////////
// Modified version to support two displays using a TCA 9548.
// 30 June 2022            by jkl
//******* Warning!!! I have no way to test this code. Once it is tested and verified, this
//*******     warning can be removed.     -jkl    ******************
//   1 July 2022   Rev.1 adds include of Wire.h                -jkl
// Adds support for a4988 driver for VID2905 stepper motor. Provides Tachometer reading.
//   12 November 2022       by jkl
////////////////////////////////////////////////////////////////////////////////////////////


#include "U8glib.h"
//#include "SdFat.h"
#include <SPI.h>
#include <Wire.h>
#include <EEPROM.h>
#include <MD_KeySwitch.h>
// Include the AccelStepper Library
#include <AccelStepper.h>

#define VREF_MEASURED 3.32      //Измеренное опорное напряжение с 3.3В стабилизатора

// выбрать один вариант логирования
#define LOGGING_MINIMAL   // Запись минимума данных
//#define LOGGING_FULL    // Запись на SD всех данных
//#define LOGGING_DEBUG   // Запись на SD всех данных + статистику расхода и пробега
//#define SECOND_O2SENS   // Включение 2го сенсора кислорода для V движков
#define DEBUG_OUTPUT false // for debug option - swith output to Serial

//DEFINE пинов под входы-выходы
#define LED_PIN         6
#define OX_PIN          0 // A0 для сенсора кислорода
#define TT_PIN          1 // A1 для сенсора ТТ АКПП
#define ENGINE_DATA_PIN 2 // D2 VF1 PIN
#define TOGGLE_BTN_PIN  7 // D7 batton A PIN
#define TOGGLE_BTN_PINb 6 // D6 batton B PIN
#define INJECTOR_PIN    3 // D3 Номер ноги для форсунки
#define SS              5 // D5 Номер ноги SS SD модуля

//DEFINE констант расходомера
#define Ls 0.055         // производительсность форсунки литров в секунду // базовый 0.004 или 240cc
#define Ncyl 4           // кол-во цилиндров

//DEFINE модуля записи на SD карту
//#define FILE_BASE_NAME "Data"   //шаблон имени файла
//#define error(msg) sd.errorHalt(&Serial,F(msg)) //ошибки при работе с SD

//DEFINE OBD READER
#define  MY_HIGH  HIGH //LOW    //Инвертировать линию Eng с помощью оптосоединителя, если у вас нет, то измените эти определения low & high на противоположные.
#define  MY_LOW   LOW //HIGH
#define  TOYOTA_MAX_BYTES  24
#define OBD_INJ 1      //Injector pulse width (INJ)   Длительность импульса инжектора
#define OBD_IGN 2      //Ignition timing angle (IGN)  Угол опережения зажигания
#define OBD_IAC 3      //Idle Air Control (IAC)       Контроль холостого хода Воздуха
#define OBD_RPM 4      //Engine speed (RPM)           Частота вращения двигателя
#define OBD_MAP 5      //Manifold Absolute Pressure (MAP)  Абсолютное давление в коллекторе
#define OBD_ECT 6      //Engine Coolant Temperature (ECT)  Температура охлаждающей жидкости двигателя
#define OBD_TPS 7      //Throttle Position Sensor (TPS)    Датчик положения дроссельной заслонки
#define OBD_SPD 8      //Speed (SPD)                       Скорость
#define OBD_OXSENS 9   // Лямбда 1
#ifdef SECOND_O2SENS
#define OBD_OXSENS2 10 // Лямбда 2 на V-образных движка. У меня ее нету.
#endif

// I2C address of the TCA 9548
#define TCAADDR 0x70
// display channels on TCA 9548
#define DISPLAY_0  
#define DISPLAY_1  

// For each display, create a separate instance.

U8GLIB_SSD1306_128X64 u8g_0(U8G_I2C_OPT_NONE);    // Display #0
U8GLIB_SSD1306_128X64 u8g_1(U8G_I2C_OPT_NONE);    // Display #1

// Установка выводов
const int dirPin = 28;
const int stepPin = 26;
const int en = 30;          // this connection is not needed. 
const int stepsperevolution = 300;

// modified for tach stepper and controller
AccelStepper tachStepper(AccelStepper::DRIVER, stepPin, dirPin);           // works for a4988 (Bipolar, constant current, step/direction driver)
const long STEPS_PER_REVOLUTION = 315;     // for the VID2905 stepper
// Set this value based on a4988 configuration. 
// 1 = full step, 2 = 1/2 step, 4 = 1/4 step, 8 = 1/8 step  
const int uSteps = 2;   // micro step rate
const int MAX_RPM_RANGE = 7000;      // Maximum RPM range to display for your car

//SdFat sd;
//SdFile file;

MD_KeySwitch S(TOGGLE_BTN_PIN, HIGH);
byte CurrentDisplayIDX = 1, TT_last = 0, TT_curr = 0;
float total_fuel_consumption = 0, trip_fuel_consumption = 0;
float trip_avg_fuel_consumption;
float cycle_obd_inj_dur = 0;
float cycle_trip = 0;
float trip_inj_dur = 0;
float total_inj_dur_ee = 0;
float current_trip = 0;
float total_trip = 0;
float all_trip_b = 0;
float all_fuel_b = 0;
float total_avg_consumption;
float total_avg_speed;
float trip_avg_speed;

unsigned long current_time = 0;
unsigned long total_time = 0;
unsigned long t;
unsigned long last_log_time = 0;
unsigned long odometer;
bool flagNulSpeed = true;
unsigned int OX, TT;

volatile uint8_t ToyotaNumBytes, ToyotaID, ToyotaData[TOYOTA_MAX_BYTES];
volatile uint16_t ToyotaFailBit = 0;
boolean LoggingOn = false; // dfeine connection flag and last success packet - for lost connection function.

void setup() {
//  char fileName[13] = FILE_BASE_NAME "00.csv";
//  const uint8_t BASE_NAME_SIZE = sizeof(FILE_BASE_NAME) - 1;
//  noInterrupts();
  Serial.begin(115200);
  delay(100);
  
  //EEPROM.put(200, odometer); запись значения одометра
  EEPROM.get(104, total_trip);
  EEPROM.get(108, total_time);
  EEPROM.get(200, odometer);
  EEPROM.get(204, total_inj_dur_ee);
  EEPROM.get(50, all_trip_b);
  EEPROM.get(58, all_fuel_b);
  analogReference(EXTERNAL);

// NOTE!!! VERY IMPORTANT!!!
// Must call this once manually before first call to TCAselect()
  Wire.begin();
  
// Call TCAselect to set the channel.
  TCAselect(DISPLAY_0); // TCA channel for display 0
  u8g_0.begin();        // use the default values
  u8g_0.setFont(u8g_font_profont15r);    // I am guessing about this initialization????!!!!!

  TCAselect(DISPLAY_1); // TCA channel for display 1
  u8g_1.begin();        // use the default values
  u8g_1.setFont(u8g_font_profont15r);    // I am guessing about this initialization????!!!!!

  S.begin();
  S.enableDoublePress(true);
  S.enableLongPress(true);
  S.enableRepeat(false);
  S.enableRepeatResult(false);
  S.setDoublePressTime(300);
  S.setLongPressTime(2000);
//u8g.setFont(u8g_font_profont15r);
  if (DEBUG_OUTPUT) {
    Serial.println("system Started");
    Serial.println("Read float from EEPROM: ");
    Serial.print("total_trip ");
    Serial.println(total_trip, 3);
    Serial.print("total_time ");
    Serial.println(total_time, 3);
    Serial.print("odometer ");
    Serial.println(odometer, 1);
    Serial.print("total_inj_dur_ee ");
    Serial.println(total_inj_dur_ee, 3);
    Serial.print("all_fuel_b ");
    Serial.println(all_fuel_b, 3);
    Serial.print("all_trip_b ");
    Serial.println(all_trip_b, 3);
    }

/*
  if (!sd.begin(SS, SPI_FULL_SPEED )) {
    sd.initErrorHalt(&Serial);
  }
  if (BASE_NAME_SIZE > 6) {
    error("FILE_BASE_NAME too long");
  }
  if (sd.exists("Data99.csv")) //очистка SD карты если логов более 99 штук
  {
    u8g.setFont(u8g_font_profont15r);
    u8g.firstPage();
    do {
      u8g.drawStr( 0, 17, "WIPE DATA!" );
    } while ( u8g.nextPage() );

    if (!sd.wipe()) {
      sd.errorHalt("Wipe failed.");
    }
    if (!sd.begin(SS, SPI_FULL_SPEED )) {
      sd.initErrorHalt();
    }
  }

  while (sd.exists(fileName)) {
    if (fileName[BASE_NAME_SIZE + 1] != '9') {
      fileName[BASE_NAME_SIZE + 1]++;
    } else if (fileName[BASE_NAME_SIZE] != '9') {
      fileName[BASE_NAME_SIZE + 1] = '0';
      fileName[BASE_NAME_SIZE]++;
    } else {
      error("Can't create file name");
    }
  }

  if (!file.open(fileName, O_CREAT | O_WRITE  | O_EXCL)) {
    error("file.open");
  }
  writeHeader();
*/
  tachStepper.setMaxSpeed(250 * uSteps);          // these valuses seem to work for VID2905
  tachStepper.setAcceleration(250 * uSteps);
  tachStepper.runToNewPosition(-300 * uSteps);    // move to zero position
 //tachStepper.setCurrentPosition(0);              // set as 0 rpm reference
 //tachStepper.runToNewPosition(300 * uSteps);     // move needle full scale
  tachStepper.runToNewPosition(10 * uSteps);      // now move needle almost to zero  -- tach is ready to use.
  delay(1000);
  
  pinMode(ENGINE_DATA_PIN, INPUT); // VF1 PIN
  pinMode(LED_PIN, OUTPUT);
  attachInterrupt(digitalPinToInterrupt(ENGINE_DATA_PIN), ChangeState, CHANGE); //setup Interrupt for data line  Настройка прерывания для линии передачи данных
  pinMode(TOGGLE_BTN_PIN, INPUT);           // кнопка СЛЕД. ЭКРАН
  CurrentDisplayIDX = 1; // set to display 1
  drawScreenSelector();
  //Расходомер
  t = millis();
  last_log_time = millis();
  interrupts();
  delay(1000);
} // END VOID SETUP

void loop(void) {
  unsigned long new_t;
  unsigned int diff_t;
  switch (S.read())
  {
    case MD_KeySwitch::KS_NULL:  break;
    case MD_KeySwitch::KS_PRESS: ent(); break;
    case MD_KeySwitch::KS_DPRESS:break;
    //{
    //  if (LoggingOn == false) LoggingOn = true; else LoggingOn = false;
    //  } break;
    case MD_KeySwitch::KS_LONGPRESS: {
        if (CurrentDisplayIDX == 5) cleardataB(); else cleardata();
         } break; 
      
    case MD_KeySwitch::KS_RPTPRESS: break;
  }

  if (ToyotaNumBytes > 0)  {    // if found bytes
    new_t = millis();
    tachStepper.moveTo((long)(map(getOBDdata(OBD_RPM), 0, MAX_RPM_RANGE, 1, STEPS_PER_REVOLUTION * uSteps * 2)));
    if (new_t > t && getOBDdata(OBD_RPM) > 100 ) {// выполняем только когда на работающем двигателе
      diff_t = new_t - t;
      cycle_obd_inj_dur = getOBDdata(OBD_RPM) / 60000 * Ncyl * (float)diff_t  * getOBDdata(OBD_INJ); //Время открытых форсунок за 1 такт данных. В МС
      //ОБ/М           ОБ/С
      //форсунка срабатывает раз в 2 оборота КВ
      //6форсунок в с
      //время цикла мс в с. Получаем кол-во срабатываний за время цикла. Умножаем на время открытия форсунки, получаем время открытия 6 форсунок В МИЛЛИСЕКУНДАХ
        
         
      trip_inj_dur += cycle_obd_inj_dur;           //Время открытых форсунок за поездку        В МС
      total_inj_dur_ee += cycle_obd_inj_dur;       //Время открытых форсунок за все время. EEPROM    В МС

      trip_fuel_consumption = trip_inj_dur / 1000 * Ls;       //потребление топлива за поездку в литрах
      total_fuel_consumption = total_inj_dur_ee / 1000 * Ls;  //потребление топлива за все время. Из ЕЕПРОМ в литрах


      cycle_trip = (float)diff_t / 3600000 * getOBDdata(OBD_SPD);   //расстояние пройденное за такт обд данных
      current_trip += cycle_trip;  //Пройденное расстояние с момента включения. В КМ
      total_trip += cycle_trip;    //Полное пройденное расстояние. EEPROM. В КМ
      odometer += cycle_trip;      //электронный одометр. Хранится в еепром и не стирается кнопкой
      current_time += diff_t;      //Время в пути в миллисекундах с момента включения
      total_time += diff_t;        //полное пройденное время в миллисекундах лимит ~49 суток. EEPROM

      trip_avg_speed = current_trip / (float)current_time * 3600000 ;       //средняя скорость за поездку
      total_avg_speed = total_trip / (float)total_time * 3600000;           // средняя скорость за все время. км\ч
      trip_avg_fuel_consumption = 100 * trip_fuel_consumption / current_trip; //средний расход за поездку
      total_avg_consumption = 100 * total_fuel_consumption / total_trip;      //среднее потребление за все время - Л на 100км
      
      all_trip_b += cycle_trip ;        //Полное пройденное расстояние. EEPROM. В КМ
      all_fuel_b += cycle_obd_inj_dur;  //Время открытых форсунок за все время. EEPROM    В МС
     
      t = new_t;//тест

    //  if (LoggingOn == true) logData(); //запись в лог данных по двоному нажатию на кнопку

      updateEepromData();   //запись данных при остановке

      if (millis() - last_log_time > 180000) {  //Запись данных в EEPROM каждые 3 минуты. Чтобы не потерять данные при движении на трассе
        EEPROM.put(104, total_trip);
        EEPROM.put(108, total_time);
        EEPROM.put(200, odometer);
        EEPROM.put(204, total_inj_dur_ee);
        EEPROM.put(50, all_trip_b);
        EEPROM.put(58, all_fuel_b);
        
        last_log_time = millis();
      }
    }
    drawScreenSelector();   // draw screen
    ToyotaNumBytes = 0;     // reset the counter.
  } // end if (ToyotaNumBytes > 0)
  tachStepper.run();
 /* if (millis() % 50 == 0 && LoggingOn == true && CurrentDisplayIDX == 6) { //каждые 50мс, когда включено логирование и выбран экран с флагами(!)
    OX = analogRead(OX_PIN);
    if (OX < 400) { //исключаю ложные показание > ~1.3В
      file.write(';');
      file.print(((float)OX * VREF_MEASURED) / 1024, 3 );
      file.println();
    }
  }
  if (millis() % 500 == 0) {  //каждые пол секунды читаем состояние АКПП
    TT = analogRead(TT_PIN);
    TT_curr = (int)(TT * VREF_MEASURED / 1024 * 3.13 + 0.5);
    if (TT_last != TT_curr) {
      drawScreenSelector();
      TT_last = TT_curr;
    }
    //Serial.println((float)TT * VREF_MEASURED / 1024 * 3.13, 3);
    // Serial.println((int)(TT * VREF_MEASURED / 1024 * 3.13+0.5));
  }
*/
//if (millis() % 5000 < 50) autoscreenchange();      // ротация экранов
}

void updateEepromData() {
  if (getOBDdata(OBD_SPD) == 0 && flagNulSpeed == false)  {   //Запись данных в еепром когда остановка авто
    EEPROM.put(104, total_trip);
    EEPROM.put(108, total_time);
    EEPROM.put(200, odometer);
    EEPROM.put(204, total_inj_dur_ee);
    EEPROM.put(50, all_trip_b);
    EEPROM.put(58, all_fuel_b);
    flagNulSpeed = true;                                  //запрет повторной записи
    last_log_time = millis();                             //чтобы не писать лишний раз
  }
  if (getOBDdata(OBD_SPD) != 0) flagNulSpeed = false;     //начали двигаться - разрешаем запись
}

void cleardata() {
  int i;
  for (i = 104; i <= 112; i++) {
  EEPROM.update(i, 0);
  }
  for (i = 200; i <= 208; i++) {
  EEPROM.update(i, 0);
  }
  EEPROM.get(104, total_trip);
  EEPROM.get(108, total_time);
  EEPROM.get(204, total_inj_dur_ee);

}

void cleardataB () {
  int i;
  for (i = 50; i <= 62; i++) {
  EEPROM.update(i, 0);
  }

  EEPROM.get(50, all_trip_b);
  EEPROM.get(58, all_fuel_b);
  
}

/*void writeHeader() {
#ifdef LOGGING_FULL
  file.print(F(";OX_RAW;INJ TIME;IGN;IAC;RPM;MAP;ECT;TPS;SPD;VF1;OX;ASE;COLD;KNOCK;OPEN LOOP;Acceleration Enrichment;STARTER;IDLE;A/C;NEUTRAL;AVG SPD;LPK_OBD;LPH_OBD;TOTAL_OBD;AVG_OBD;CURR_OBD;CURR_RUN;total_trip"));
#endif
#ifdef LOGGING_DEBUG
  file.print(F(";OX_RAW;INJ TIME;IGN;IAC;RPM;MAP;ECT;TPS;SPD;VF1;OX;AVG SPD;LPK_OBD;LPH_OBD;TOTAL_OBD;AVG_OBD;CURR_OBD;CURR_RUN;total_trip"));
#endif
#ifdef LOGGING_MINIMAL
  file.print(F(";OX_RAW;INJ TIME;IGN;IAC;RPM;MAP;ECT;TPS;SPD;VF1;OX;LPH_OBD"));
#endif
  file.println();
  file.sync();
}
*/
//обнуление данных


/*void logData() {
  file.print(float(millis()) / 60000, 3); file.write(';')   ; file.write(';');
  file.print(getOBDdata(OBD_INJ)); file.write(';'); file.print(getOBDdata(OBD_IGN));  file.write(';');  file.print(getOBDdata(OBD_IAC));  file.write(';');
  file.print(getOBDdata(OBD_RPM)); file.write(';'); file.print(getOBDdata(OBD_MAP));  file.write(';'); file.print(getOBDdata(OBD_ECT));  file.write(';');
  file.print(getOBDdata(OBD_TPS)); file.write(';');  file.print(getOBDdata(OBD_SPD));  file.write(';'); file.print(getOBDdata(OBD_OXSENS)); file.write(';'); file.print(getOBDdata(20)); file.write(';');
#ifdef LOGGING_FULL
  file.print(getOBDdata(11)); file.write(';'); file.print(getOBDdata(12)); file.write(';'); file.print(getOBDdata(13)); file.write(';'); file.print(getOBDdata(14)); file.write(';');
  file.print(getOBDdata(15)); file.write(';'); file.print(getOBDdata(16)); file.write(';'); file.print(getOBDdata(17)); file.write(';'); file.print(getOBDdata(18)); file.write(';');
  file.print(getOBDdata(19)); file.write(';');
#endif
#ifdef  LOGGING_DEBUG
  // file.print(total_avg_speed); file.write(';');                                                                   //AVG_SPD       ok
  // file.print(100 / getOBDdata(OBD_SPD) * (getOBDdata(OBD_INJ) * getOBDdata(OBD_RPM)*Ls * 0.18)); file.write(';');  //LPK_OBD      ok
#endif
  file.print(getOBDdata(OBD_INJ) * getOBDdata(OBD_RPM)*Ls * 0.18); file.write(';');                                //LPH_OBD    ok
#ifdef LOGGING_DEBUG
  //file.print(total_fuel_consumption); file.write(';');   //TOTAL_OBD     ok
  //file.print(trip_avg_fuel_consumption); file.write(';');   //!AVG_OBD
  //file.print(trip_fuel_consumption); file.write(';');  //!CURR_OBD
  //file.print(current_trip);   file.write(';');    //CURR_RUN ok
  //file.print(total_trip); file.write(';');//RUN_TOTAL      ok
#endif
  file.println();
  file.sync();
}
*/
void drawScreenSelector(void) {
  if (CurrentDisplayIDX == 1) DrawCurrentFuelConsuption();
  else if (CurrentDisplayIDX == 2) drawTripTimeDistance();
  else if (CurrentDisplayIDX == 3) drawTimeDistance();
  else if (CurrentDisplayIDX == 4) DrawTotalFuelConsuption();
  else if (CurrentDisplayIDX == 5) drawTotalFuelDistanceB();
  else if (CurrentDisplayIDX == 6) drawAllData();
  else if (CurrentDisplayIDX == 7) drawExtraData();
} // end drawScreenSelector()

void DrawCurrentFuelConsuption(void) {
  TCAselect(DISPLAY_0);   // this will be displayed on display 0
  u8g_0.setFont(u8g_font_profont15r);
  u8g_0.firstPage();
  do {
  u8g_0.setFont(u8g_font_profont15r);
  u8g_0.drawStr( 0, 15, "TRIP" );
  u8g_0.drawStr( 74, 15, "L" );
  u8g_0.setPrintPos(35, 15) ;
  u8g_0.print(trip_fuel_consumption, 1);
  if (LoggingOn == true)  u8g_0.drawHLine(20, 24, 88);
  //  u8g.setPrintPos(90, 20) ;
  //  u8g.print((float)TT * VREF_MEASURED / 1024 * 3.13, 2);
/*
    u8g.setFont(u8g_font_profont22r);
    switch (TT_curr) { //для делителя 10k + 4.7k
      case 0: u8g.drawStr( 95, 20, "1" );   break;
      case 2: u8g.drawStr( 95, 20, "2" ); break;
      case 4: u8g.drawStr( 95, 20, "3" ); break;
      case 5: u8g.drawStr( 95, 20, "3L" ); break;
      case 6: u8g.drawStr( 95, 20, "4" ); break;
      case 7: u8g.drawStr( 95, 20, "4L" ); break;
    }*/
    if (getOBDdata(OBD_SPD) > 1)
    {
      u8g_0.setFont(u8g_font_profont15r);
      u8g_0.drawStr( 0, 42, "L/100Km" );
      u8g_0.setFont(u8g_font_profont22r);
      u8g_0.setPrintPos(0, 60) ;
   // u8g.print( 100 / getOBDdata(OBD_SPD) * (getOBDdata(OBD_INJ) * getOBDdata(OBD_RPM)*Ls * 0.18), 1);
      u8g_0.print( 100 / getOBDdata(OBD_SPD) * (getOBDdata(OBD_INJ)/1000 *Ls*4* getOBDdata(OBD_RPM)*60), 1);
    } else {
      u8g_0.setFont(u8g_font_profont15r);
      u8g_0.drawStr( 0, 42, "L/Hour" );
      u8g_0.setFont(u8g_font_profont22r);
      u8g_0.setPrintPos(0, 60) ;
   // u8g.print(getOBDdata(OBD_INJ) * getOBDdata(OBD_RPM)*Ls * 0.18, 1);
      u8g_0.print(getOBDdata(OBD_INJ)/1000 *Ls*4* getOBDdata(OBD_RPM)*60, 1);
    }
    u8g_0.setFont(u8g_font_profont15r);
    u8g_0.drawStr( 60, 42, "Average" );
    u8g_0.setFont(u8g_font_profont22r);
    u8g_0.setPrintPos(60, 60) ;
    if (trip_avg_fuel_consumption < 100)
      u8g_0.print( trip_avg_fuel_consumption, 1);
    else u8g_0.drawStr( 60, 60, "---" );
  }
  while ( u8g_0.nextPage() );
}

void DrawTotalFuelConsuption(void) {
  TCAselect(DISPLAY_1);   // this will be displayed on display 1
  u8g_1.setFont(u8g_font_profont15r);
  u8g_1.firstPage();
  do {
    u8g_1.setFont(u8g_font_profont15r);
    u8g_1.drawStr( 0, 15, "TOTAL" );
 // u8g.drawStr( 74, 15, "L" );
    u8g_1.drawStr( 42, 15, "Liters" );
   
  //  u8g.setPrintPos(42, 15) ;
  //  u8g.print(total_fuel_consumption, 1);
      if (LoggingOn == true)  u8g_1.drawHLine(20, 24, 88);
   // u8g.setFont(u8g_font_profont22r);
   // switch (TT_curr) { //для делителя 10k + 4.7k
    // case 0: u8g.drawStr( 95, 20, "1" ); break;
    // case 2: u8g.drawStr( 95, 20, "2" ); break;
    // case 4: u8g.drawStr( 95, 20, "3" ); break;
    // case 5: u8g.drawStr( 95, 20, "3L" ); break;
    // case 6: u8g.drawStr( 95, 20, "4" ); break;
    // case 7: u8g.drawStr( 95, 20, "4L" ); break;
    // }
   
   // if (getOBDdata(OBD_SPD) > 1)
   // {
      u8g_1.setFont(u8g_font_profont15r);
  //  u8g.drawStr( 0, 42, "L/100Km" );
      u8g_1.drawStr( 0, 42, "All" );
      u8g_1.setFont(u8g_font_profont22r);
      u8g_1.setPrintPos(0, 60) ;
      u8g_1.print(total_fuel_consumption, 1);
     // u8g.print( 100 / getOBDdata(OBD_SPD) * (getOBDdata(OBD_INJ) * getOBDdata(OBD_RPM)*Ls * 0.18), 1);
     // u8g.print( 100 / getOBDdata(OBD_SPD) * (getOBDdata(OBD_INJ) *Ls*4* getOBDdata(OBD_RPM)*60), 1);
     // } else {
     // u8g.setFont(u8g_font_profont15r);
     // u8g.drawStr( 0, 42, "L/Hour" );
     // u8g.setFont(u8g_font_profont22r);
     // u8g.setPrintPos(0, 60) ;
     // u8g.print(getOBDdata(OBD_INJ) * getOBDdata(OBD_RPM)*Ls * 0.18, 1);
     // u8g.print(getOBDdata(OBD_INJ) *Ls*4* getOBDdata(OBD_RPM)*60, 1);
     // }
    
    u8g_1.setFont(u8g_font_profont15r);
    u8g_1.drawStr( 60, 42, "Average" );
    u8g_1.setFont(u8g_font_profont22r);
    u8g_1.setPrintPos(60, 60) ;
    if (total_avg_consumption < 100)
    u8g_1.print( total_avg_consumption, 1);
    else u8g_1.drawStr( 60, 60, "---" );
  }
  while ( u8g_1.nextPage() );
}

void drawTimeDistance(void) {
  TCAselect(DISPLAY_0);   // this will be displayed on display 0
  u8g_0.setFont(u8g_font_profont15r);
  u8g_0.firstPage();
  do {
    u8g_0.setFont(u8g_font_profont15r);
    u8g_0.drawStr( 0, 15, "TOTAL" );
    u8g_0.drawStr( 90, 15, "KM" );
    u8g_0.setPrintPos(44, 15) ;
    u8g_0.print(total_trip, 1);
    if (LoggingOn == true)  u8g_0.drawHLine(20, 24, 88);
    u8g_0.setFont(u8g_font_profont22r);
   //  switch (TT_curr) { //для делителя 10k + 4.7k
   //  case 0: u8g.drawStr( 95, 20, "1" ); break;
   //  case 2: u8g.drawStr( 95, 20, "2" ); break;
   //  case 4: u8g.drawStr( 95, 20, "3" ); break;
   //  case 5: u8g.drawStr( 95, 20, "3L" ); break;
   //  case 6: u8g.drawStr( 95, 20, "4" ); break;
   //  case 7: u8g.drawStr( 95, 20, "4L" ); break;
   // }
    u8g_0.setFont(u8g_font_profont15r);
    u8g_0.drawStr( 0, 42, "Avg SPD" );
    u8g_0.setFont(u8g_font_profont22r);
    u8g_0.setPrintPos(0, 60) ;
    u8g_0.print(total_avg_speed, 1);
    u8g_0.setFont(u8g_font_profont15r);
    u8g_0.drawStr( 60, 42, "Time (M)" );
    u8g_0.setFont(u8g_font_profont22r);
    u8g_0.setPrintPos(60, 60) ;
    u8g_0.print( float(total_time) / 60000, 1);
  }
  while ( u8g_0.nextPage() );
}

void drawTripTimeDistance(void) {
  TCAselect(DISPLAY_0);   // this will be displayed on display 0
  u8g_0.setFont(u8g_font_profont15r);
  u8g_0.firstPage();
  do {
    u8g_0.setFont(u8g_font_profont15r);
    u8g_0.drawStr( 0, 15, "TRIP" );
    u8g_0.drawStr( 90, 15, "KM" );
    u8g_0.setPrintPos(44, 15) ;
    u8g_0.print(current_trip, 1);
    if (LoggingOn == true)  u8g_0.drawHLine(20, 24, 88);
    u8g_0.setFont(u8g_font_profont22r);
   // switch (TT_curr) { //для делителя 10k + 4.7k
   // case 0: u8g.drawStr( 95, 20, "1" ); break;
   // case 2: u8g.drawStr( 95, 20, "2" ); break;
   // case 4: u8g.drawStr( 95, 20, "3" ); break;
   // case 5: u8g.drawStr( 95, 20, "3L" ); break;
   // case 6: u8g.drawStr( 95, 20, "4" ); break;
   // case 7: u8g.drawStr( 95, 20, "4L" ); break;
   //  }
    u8g_0.setFont(u8g_font_profont15r);
    u8g_0.drawStr( 0, 42, "Avg SPD" );
    u8g_0.setFont(u8g_font_profont22r);
    u8g_0.setPrintPos(0, 60) ;
    u8g_0.print(trip_avg_speed, 1);
    u8g_0.setFont(u8g_font_profont15r);
    u8g_0.drawStr( 60, 42, "Time (M)" );
    u8g_0.setFont(u8g_font_profont22r);
    u8g_0.setPrintPos(60, 60) ;
    u8g_0.print( float(current_time) / 60000, 1);
  }
  while ( u8g_0.nextPage() );
}

void drawTotalFuelDistanceB(void)  //-----------TRIP B
{
  TCAselect(DISPLAY_0);   // this will be displayed on display 0
  u8g_0.setFont(u8g_font_profont15r);
  u8g_0.firstPage();
  do {
  u8g_0.setFont(u8g_font_profont15r);
  //u8g.drawStr( 0, 6, "TOTAL" );
  //u8g.drawStr( 74, 15, "L" );
  //u8g.drawStr( 20, 15, "All Trip B" );
   
 
    if (LoggingOn == true)  u8g_0.drawHLine(20, 24, 88);
  
    u8g_0.setFont(u8g_font_profont15r);
    u8g_0.drawStr( 0, 47, "Km" );
    u8g_0.setFont(u8g_font_profont15r);
    u8g_0.setPrintPos(40, 47) ;
    u8g_0.print(all_trip_b, 1);
    
    u8g_0.setFont(u8g_font_profont15r);
    u8g_0.drawStr( 0, 63, "Lit" );
    u8g_0.setFont(u8g_font_profont15r);
    u8g_0.setPrintPos(40, 63) ;
    u8g_0.print( all_fuel_b/ 1000 * Ls, 1);
    
    u8g_0.setFont(u8g_font_profont15r);
    u8g_0.drawStr( 0, 30, "L/100" );
    u8g_0.setFont(u8g_font_profont15r);
    u8g_0.setPrintPos(40, 30) ;
    u8g_0.print(  all_fuel_b / 1000 * Ls * 100 / all_trip_b , 1);
  }
  while ( u8g_0.nextPage() );
}
//}


void drawAllData(void) {
  // graphic commands to redraw the complete screen should be placed here
  TCAselect(DISPLAY_0);   // this will be displayed on display 0
  u8g_0.setFont(u8g_font_profont15r);
  u8g_0.firstPage();
  do {
    u8g_0.drawStr( 0, 17, "INJ" );
    u8g_0.setPrintPos(25, 17) ;
    u8g_0.print(getOBDdata(OBD_INJ));

    u8g_0.drawStr( 0, 32, "IGN");
    u8g_0.setPrintPos(25, 32) ;
    u8g_0.print( int(getOBDdata(OBD_IGN)));

    u8g_0.drawStr( 0, 47, "IAC");
    u8g_0.setPrintPos(25, 47) ;
    u8g_0.print( int(getOBDdata(OBD_IAC)));

    u8g_0.drawStr( 0, 62, "RPM");
    u8g_0.setPrintPos(25, 62) ;
    u8g_0.print( int(getOBDdata(OBD_RPM)));

    u8g_0.drawStr( 65, 17, "MAP" );
    u8g_0.setPrintPos(92, 17) ;
    u8g_0.print( int(getOBDdata(OBD_MAP)));

    u8g_0.drawStr( 65, 32, "ECT");
    u8g_0.setPrintPos(92, 32) ;
    u8g_0.print( int(getOBDdata(OBD_ECT)));

    u8g_0.drawStr( 65, 47, "TPS");
    u8g_0.setPrintPos(92, 47) ;
    u8g_0.print( int(getOBDdata(OBD_TPS)));

    u8g_0.drawStr( 65, 62, "SPD");
    u8g_0.setPrintPos(92, 62) ;
    u8g_0.print( int(getOBDdata(OBD_SPD)));

    u8g_0.drawVLine(63, 0, 64);
  } while ( u8g_0.nextPage() ); // end picture loop
} // end void drawalldata

void autoscreenchange() {
  CurrentDisplayIDX++;
  if (CurrentDisplayIDX > 3) CurrentDisplayIDX = 1;
  drawScreenSelector();
}
void ent() {//ПЕРЕКЛЮЧЕНИЕ ЭКРАНОВ
  CurrentDisplayIDX++;
  if (CurrentDisplayIDX > 7) CurrentDisplayIDX = 1;
  drawScreenSelector();
}

float getOBDdata(byte OBDdataIDX) {
  float returnValue;
  switch (OBDdataIDX) {
    case 0:// UNKNOWN
      returnValue = ToyotaData[0];
      break;
    case OBD_INJ: //  Время впрыска форсунок  =X*0.125 (мс) (x / 8)
      returnValue = ToyotaData[OBD_INJ] / 8 ;  //* 0.125; //Время впрыска форсунок x/10
      break;
    case OBD_IGN: // Угол опережения зажигания X*0.47-30 (град)
      returnValue = ToyotaData[OBD_IGN] * 0.47 - 30;
      break;
    case OBD_IAC: //  Состояние клапана ХХ Для разных типов КХХ разные формулы: X/255*100 (%)
      //  X (шаг)
      returnValue = ToyotaData[OBD_IAC] * 0.39215; ///optimize divide
      break;
    case OBD_RPM: //Частота вращения коленвала X*25(об/мин)
      returnValue = ToyotaData[OBD_RPM] * 25;
      break;
    case OBD_MAP: //Расходомер воздуха (MAP/MAF)
      //  X*0.6515 (кПа)
      //  X*4.886 (мм.ртут.столба)
      //  X*0.97 (кПа) (для турбомоторов)
      //  X*7.732 (мм.рт.ст) (для турбомоторов)
      //  x*2(гр/сек) (данная формула для MAF так и не найдена)
      //  X/255*5 (Вольт) (напряжение на расходомере)
      returnValue = ToyotaData[OBD_MAP] * 4.886; //MAF
      break;
    case OBD_ECT: // Температура двигателя (ECT)
      // В зависимости от величины Х разные формулы:
      // 0..14:          =(Х-5)*2-60
      // 15..38:        =(Х-15)*0.83-40
      // 39..81:        =(Х-39)*0.47-20
      // 82..134:      =(Х-82)*0.38
      // 135..179:    =(Х-135)*0.44+20
      // 180..209:    =(Х-180)*0.67+40
      // 210..227:    =(Х-210)*1.11+60
      // 228..236:    =(Х-228)*2.11+80
      // 237..242:    =(Х-237)*3.83+99
      // 243..255:    =(Х-243)*9.8+122
      // Температура в градусах цельсия.
      if (ToyotaData[OBD_ECT] >= 243)
        returnValue = ((float)(ToyotaData[OBD_ECT] - 243) * 9.8) + 122;
      else if (ToyotaData[OBD_ECT] >= 237)
        returnValue = ((float)(ToyotaData[OBD_ECT] - 237) * 3.83) + 99;
      else if (ToyotaData[OBD_ECT] >= 228)
        returnValue = ((float)(ToyotaData[OBD_ECT] - 228) * 2.11) + 80.0;
      else if (ToyotaData[OBD_ECT] >= 210)
        returnValue = ((float)(ToyotaData[OBD_ECT] - 210) * 1.11) + 60.0;
      else if (ToyotaData[OBD_ECT] >= 180)
        returnValue = ((float)(ToyotaData[OBD_ECT] - 180) * 0.67) + 40.0;
      else if (ToyotaData[OBD_ECT] >= 135)
        returnValue = ((float)(ToyotaData[OBD_ECT] - 135) * 0.44) + 20.0;
      else if (ToyotaData[OBD_ECT] >= 82)
        returnValue = ((float)(ToyotaData[OBD_ECT] - 82) * 0.38);
      else if (ToyotaData[OBD_ECT] >= 39)
        returnValue = ((float)(ToyotaData[OBD_ECT] - 39) * 0.47) - 20.0;
      else if (ToyotaData[OBD_ECT] >= 15)
        returnValue = ((float)(ToyotaData[OBD_ECT] - 15) * 0.83) - 40.0;
      else
        returnValue = ((float)(ToyotaData[OBD_ECT] - 15) * 2.0) - 60.0;
      break;
    case OBD_TPS: // Положение дроссельной заслонки
      // X/2(градусы)
      // X/1.8(%)
      returnValue = ToyotaData[OBD_TPS] / 1.8;
      break;
    case OBD_SPD: // Скорость автомобиля (км/час)
      returnValue = ToyotaData[OBD_SPD];
      break;
  //  Коррекция для рядных/ коррекция первой половины
    case OBD_OXSENS:
      returnValue = (float)ToyotaData[OBD_OXSENS] * 0.01953125;
      break;

#ifdef SECOND_O2SENS
    case OBD_OXSENS2:// Lambda2 tst
      returnValue = (float)ToyotaData[OBD_OXSENS2] * 0.01953125;
      break;
#endif

    //  читаем Байты флагов побитно
    case 11:
      returnValue = bitRead(ToyotaData[11], 0); //Переобогащение после запуска 1-Вкл
      break;
    case 12:
      returnValue = bitRead(ToyotaData[11], 1); //Холодный двигатель 1-Да
      break;
    case 13:
      returnValue = bitRead(ToyotaData[11], 4); //Детонация 1-Да
      break;
    case 14:
      returnValue = bitRead(ToyotaData[11], 5); //Обратная связь по лямбда зонду 1-Да
      break;
    case 15:
      returnValue = bitRead(ToyotaData[11], 6); //Дополнительное обогащение 1-Да
      break;
    case 16:
      returnValue = bitRead(ToyotaData[12], 0); //Стартер 1-Да
      break;
    case 17:
      returnValue = bitRead(ToyotaData[12], 1); //Признак ХХ (Дроссельная заслонка) 1-Да(Закрыта)
      break;
    case 18:
      returnValue = bitRead(ToyotaData[12], 2); //Кондиционер 1-Да
      break;
    case 19:
      returnValue = bitRead(ToyotaData[12], 3); //Нейтраль 1-Да
      break;
    case 20:
      returnValue = bitRead(ToyotaData[12], 4); //Смесь  первой половины 1-Богатая, 0-Бедная
      break;

#ifdef SECOND_O2SENS //Вторая лябмда для Vобразных движков
    case 21:
      returnValue = bitRead(ToyotaData[12], 5); //Смесь второй половины 1-Богатая, 0-Бедная
      break;
#endif

    default: // DEFAULT CASE (in no match to number)
   // send "error" value
      returnValue =  9999.99;
  } // end switch
  // send value back
  return returnValue;
} // end void getOBDdata


void ChangeState() {
  static uint8_t ID, EData[TOYOTA_MAX_BYTES];
  static boolean InPacket = false;
  static unsigned long StartMS;
  static uint16_t BitCount;
  int state = digitalRead(ENGINE_DATA_PIN);
  digitalWrite(LED_PIN, state);
    if (InPacket == false)  {
    if (state == MY_HIGH)   {
      StartMS = millis();
    }   else   { // else  if (state == MY_HIGH)
    if ((millis() - StartMS) > (15 * 8))   {
        StartMS = millis();
        InPacket = true;
        BitCount = 0;
      } // end if  ((millis() - StartMS) > (15 * 8))
    } // end if  (state == MY_HIGH)
  }  else   { // else  if (InPacket == false)
    uint16_t bits = ((millis() - StartMS) + 1 ) / 8; // The +1 is to cope with slight time errors
    StartMS = millis();
    // process bits
    while (bits > 0)  {
    if (BitCount < 4)  {
    if (BitCount == 0)
          ID = 0;
        ID >>= 1;
    if (state == MY_LOW)  // inverse state as we are detecting the change!
          ID |= 0x08;
      }   else    { // else    if (BitCount < 4)
        uint16_t bitpos = (BitCount - 4) % 11;
        uint16_t bytepos = (BitCount - 4) / 11;
    if (bitpos == 0)      {
          // Start bit, should be LOW
    if ((BitCount > 4) && (state != MY_HIGH))  { // inverse state as we are detecting the change!
            ToyotaFailBit = BitCount;
            InPacket = false;
            break;
          } // end if ((BitCount > 4) && (state != MY_HIGH))
        }  else if (bitpos < 9)  { //else TO  if (bitpos == 0)
          EData[bytepos] >>= 1;
    if (state == MY_LOW)  // inverse state as we are detecting the change!
            EData[bytepos] |= 0x80;
        } else { // else if (bitpos == 0)
          // Stop bits, should be HIGH
    if (state != MY_LOW)  { // inverse state as we are detecting the change!
            ToyotaFailBit = BitCount;
            InPacket = false;
            break;
          } // end if (state != MY_LOW)
    if ( (bitpos == 10) && ((bits > 1) || (bytepos == (TOYOTA_MAX_BYTES - 1))) ) {
            ToyotaNumBytes = 0;
            ToyotaID = ID;
            for (uint16_t i = 0; i <= bytepos; i++)
              ToyotaData[i] = EData[i];
            ToyotaNumBytes = bytepos + 1;
    if (bits >= 16)  // Stop bits of last byte were 1's so detect preamble for next packet
              BitCount = 0;
            else  {
              ToyotaFailBit = BitCount;
              InPacket = false;
            }
            break;
          }
        }
      }
      ++BitCount;
      --bits;
    } // end while
  } // end (InPacket == false)
} // end void change

void drawExtraData(void) {
  TCAselect(DISPLAY_0);   // this will be displayed on display 0
  u8g_0.setFont(u8g_font_profont15r);
  u8g_0.firstPage();
  do {
    u8g_0.drawStr( 0, 15, "VF" );
    u8g_0.setPrintPos(25, 15) ;
    u8g_0.print(getOBDdata(OBD_OXSENS), 1);
    if (int(getOBDdata(11)) == 1) {
    u8g_0.drawStr( 0, 30, "ASE");
    }
    if (int(getOBDdata(12)) == 1) {
    u8g_0.drawStr( 0, 45, "CLD");
    }
    if (int(getOBDdata(13)) == 1) {
    u8g_0.drawStr( 0, 60, "KNK");
    }
    if (int(getOBDdata(14)) == 1) {
    u8g_0.drawStr( 40, 30, "OL");
    }
    if (int(getOBDdata(15)) == 1) {
    u8g_0.drawStr( 40, 45, "AE");
    }
    if (int(getOBDdata(16)) == 1) {
    u8g_0.drawStr( 40, 60, "STA");
    }
    if (int(getOBDdata(17)) == 1) {
    u8g_0.drawStr( 70, 30, "IDL");
    }
    if (int(getOBDdata(18)) == 1) {
    u8g_0.drawStr( 70, 45, "A/C");
    }
    if (int(getOBDdata(19)) == 1) {
    u8g_0.drawStr( 70, 60, "NSW");
    }
    if (int(getOBDdata(20)) == 0) {
    u8g_0.drawStr(70, 15, "LEAN");
    } else  {
    u8g_0.drawStr(70, 15, "RICH");
    }
  }
  while ( u8g_0.nextPage() );
}

// Helper function for changing TCA output channel
// Call this function whenever changing displays.
void TCAselect(uint8_t channel) {
  if (channel > 7) return;
  Wire.beginTransmission(TCAADDR);
  Wire.write(1 << channel);
  Wire.endTransmission();  
}