           }
           Serial.println();          
         }
+        */
 
 
   }

  if(currentMillis - lastMillis >= interval) {
    lastMillis = currentMillis;
    lcd.setCursor(4, 2);
    lcd.print(tgt);
    draw_bar(tgt, 3, 10.0, 20.0);

    lcd.setCursor(4, 0);
    lcd.print(afr);
    draw_bar(afr, 1, 10.0, 20.0);
    
    //Serial.println(tgt);
    //Serial.println((double)badDataCount / (double)goodDataCount);


        unsigned int canId = CAN.getCanId();
        
        switch(canId) {
          case 1514:
            engine_tgt.currentValue = (double)buf[0] / 10.0;
            engine_afr.currentValue = (double)buf[1] / 10.0;
            break;
          default:
            //do nothing
            break;
        }
          /*
        if(canId == 1514) {
          Serial.println("-----------------------------");
          Serial.print("Get data from ID: ");
