Arduino sketch and Broadband Lambda probe (sdk) bosch lcu 4.9?

Question

Arduino

The question arose about setting the subbrain to auto, for implementation it is necessary to read the SDC readings, it should always be 14.65. How to connect and register the sketch correctly, on which pins and algorithm of work, who knows?

Sketch for adruino leonardo with lsd robot

#include <LiquidCrystal.h>
LiquidCrystal lcd(8, 9, 4, 5, 6, 7);

byte inByte1 = 0; // incoming serial byte1 -- header
byte inByte2 = 0; // incoming serial byte2 -- header
byte inByte3 = 0; // incoming serial byte3 -- word1
byte inByte4 = 0; // incoming serial byte4 -- word1
byte inByte5 = 0; // incoming serial byte5 -- word2
byte inByte6 = 0; // incoming serial byte6 -- word2
byte B = 0; // number of packets

word AF = 0; //stoichiometric AFR value of current fuel setting in the LM-1

unsigned int L = 0; // Lambda value
unsigned int LPrev = 0;

byte F = 0; // Function value
byte FPrev = 0; // Function value
byte NoData = 0;

void setup() {
  Serial.begin(19200);
  lcd.begin(16, 2);
  lcd.print("TOYOTA  MARK 110 ");
  delay(6000);
}
void loop() {
  if (Serial.available() > 6) { //checks if data on serial coonection are available

    inByte1 = Serial.read(); //reads first byte of data 
    if (bitRead(inByte1, 7) && bitRead(inByte1, 5) && bitRead(inByte1, 1)) { //checks if inByte1 is header of data packet
      inByte2 = Serial.read(); //reads second byte of data    
      if (bitRead(inByte2, 7)) { //checks if inByte2 is second byte of header
        bitWrite(B, 0, bitRead(inByte2, 0));
        bitWrite(B, 1, bitRead(inByte2, 1));
        bitWrite(B, 2, bitRead(inByte2, 2));
        bitWrite(B, 3, bitRead(inByte2, 3));
        bitWrite(B, 4, bitRead(inByte2, 4));
        bitWrite(B, 5, bitRead(inByte2, 5));
        bitWrite(B, 6, bitRead(inByte2, 6));
        bitWrite(B, 7, bitRead(inByte1, 0)); //calculates number of packets from header
        if (B > 1) { //checks if packet consists any data except header
          inByte3 = Serial.read(); //read afr packet
          inByte4 = Serial.read(); //read afr packet
          bitWrite(F, 0, bitRead(inByte3, 2));
          bitWrite(F, 1, bitRead(inByte3, 3));
          bitWrite(F, 2, bitRead(inByte3, 4)); //calculates wb controller status variable
          bitWrite(AF, 0, bitRead(inByte4, 0));
          bitWrite(AF, 1, bitRead(inByte4, 1));
          bitWrite(AF, 2, bitRead(inByte4, 2));
          bitWrite(AF, 3, bitRead(inByte4, 3));
          bitWrite(AF, 4, bitRead(inByte4, 4));
          bitWrite(AF, 5, bitRead(inByte4, 5));
          bitWrite(AF, 6, bitRead(inByte4, 6));
          bitWrite(AF, 7, bitRead(inByte3, 0)); //calculates afr which is defined as stechoimetric
          inByte5 = Serial.read(); //read lambda packet
          inByte6 = Serial.read(); //read lambda packet
          bitWrite(L, 0, bitRead(inByte6, 0));
          bitWrite(L, 1, bitRead(inByte6, 1));
          bitWrite(L, 2, bitRead(inByte6, 2));
          bitWrite(L, 3, bitRead(inByte6, 3));
          bitWrite(L, 4, bitRead(inByte6, 4));
          bitWrite(L, 5, bitRead(inByte6, 5));
          bitWrite(L, 6, bitRead(inByte6, 6));
          bitWrite(L, 7, bitRead(inByte5, 0));
          bitWrite(L, 8, bitRead(inByte5, 1));
          bitWrite(L, 9, bitRead(inByte5, 2));
          bitWrite(L, 10, bitRead(inByte5, 3));
          bitWrite(L, 11, bitRead(inByte5, 4));
          bitWrite(L, 12, bitRead(inByte5, 5)); //calculates lambda value 
          if (F != FPrev) update_F(); //checks if status changed since last iteration and if it so runs screen update for status
          if (L != LPrev) update_L(); //checks if lambda changed since last iteration and if it so runs screen update for lambda
          FPrev = F;
          LPrev = L; //saves last state of lambda and status   
          NoData = 0; //clears counter which is needed to determine absence of incoming data          
        } //if (B>1)

      } //if (bitRead(inByte2,7))

    } //  if (bitRead(inByte1,7) && bitRead(inByte1,5) && bitRead(inByte1,1) )

  } //if (Serial.available() > 6)
  else NoData++;

  if (NoData > 15) { //checks if last 15 iterations were not incoming data and display it on screen if it so.
    lcd.clear();
    lcd.setCursor(3, 0);
    lcd.print("NO  SIGNAL");
    NoData = 0;
  }
  Serial.flush(); //clears serial buffer in order to avoid buffer overflow
  delay(10);

  //new_comment1
} //void loop()

void update_F() //update status on screen
{

  lcd.clear();
  lcd.setCursor(0, 0);
  lcd.print("Status:");
  lcd.setCursor(8, 0);
  switch (F) {
  case 0: //Lambda valid and Aux data valid, normal operation.

    lcd.print("OK");
    lcd.setCursor(0, 1);
    lcd.print("AirFlow:");

    break;
  case 1: //Lambda value contains O2 level in 1/10%
    lcd.print("Too lean");
    lcd.setCursor(0, 1);
    lcd.print("%O2:");

    break;
  case 2: //Free air Calib in progress, Lambda data not valid
    lcd.print("Calibration");
    lcd.setCursor(0, 3);
    lcd.print(L);

    break;
  case 3: //Need Free air Calibration Request, Lambda data not valid
    lcd.print("Need cali");

    break;
  case 4: //Warming up, Lambda value is temp in 1/10% of operating temp.
    lcd.print("PROGREV");
    lcd.setCursor(0, 1);
    lcd.print("Progress:");
    lcd.setCursor(12, 1);
    lcd.print("%");

    break;
  case 5: //Heater Calibration, Lambda value contains calibration countdown.
    lcd.print("Heater Cali");

    break;
  case 6: //Error code in Lambda value
    lcd.print("Error");
    lcd.setCursor(0, 1);
    lcd.print("Code:");

    break;
  case 7: //reserved 
    break;
  } //switch (F)
}

void update_L() //update lambda level on screen
{

  switch (F) {
  case 0: //Lambda valid and Aux data valid, normal operation.

    lcd.setCursor(5, 1);
    lcd.print((0.5 + (L * 0.001)) * (AF / 10));
    lcd.setCursor(0, 2);

    break;
  case 1: //Lambda value contains O2 level in 1/10%

    lcd.setCursor(5, 1);
    lcd.print(L / 10.0);
    break;
  case 2: //Free air Calib in progress, Lambda data not valid

    break;
  case 3: //Need Free air Calibration Request, Lambda data not valid

    lcd.setCursor(0, 3);
    lcd.print(L);

    break;
  case 4: //Warming up, Lambda value is temp in 1/10% of operating temp.

    lcd.setCursor(10, 1);
    lcd.print(L / 10);

    break;
  case 5: //Heater Calibration, Lambda value contains cal  ibration countdown.

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

    break;
  case 6: //Error code in Lambda value

    lcd.setCursor(6, 1);
    lcd.print(L);
    break;
  case 7: //reserved 

    break;
  } //switch (F)
}