//enable 2040 LCD
#include <LiquidCrystal_I2C.h>
LiquidCrystal_I2C lcd(0x27,20,4);  // set the LCD address to 0x27 for a 16 chars and 2 line display
//enable NTC thermistor
#include <GyverNTC.h>
// термистор на пине А0
// сопротивление резистора 10к
// тепловой коэффициент 3950
GyverNTC therm(0, 100000, 3950);

//enable button lib and define buttons array
#define BTN_AMOUNT 5
#define EB_HOLD 1000
#include <EncButton2.h>
EncButton2<EB_BTN> btn[BTN_AMOUNT];

//define vars
int cursor=1; //позиция курсора
int t_current=230;
int t_current_temp=230;
int t_set=230;
int t_set_temp=230;
int motor_speed=100;
int motor_speed_temp=100;
int save=100; //режим работы меню. 100- режим выбора. 1,2,3 - выбранное значение
float filT = 0; //фильтрованное значение датчика
long previousMillis = 0;        // храним время последнего переключения светодиода
long interval = 1000;           // интервал между включение/выключением светодиода (1 секунда)
void setup()
{


  lcd.init();                      // initialize the lcd 
  // Print a message to the LCD.
  lcd.backlight();
  lcd.setCursor(5,0);
  lcd.print("Welcome to");
  lcd.setCursor(0,1);
  lcd.print("PetFilament Machine");
  lcd.setCursor(2,2);
  lcd.print("Firmware ver 0.1");
  lcd.setCursor(0,3);
  lcd.print("Powered By Mirivlad");
  delay(3000);
  lcd.clear();
  lcd.setCursor(0,0);
  lcd.print("Tc: ");//4,0 - set Temperature current
  lcd.setCursor(4,0);
  lcd.print(t_current);
  lcd.setCursor(12,0);
  lcd.print("Ts: ");//16,0 - set Temperature setting
  lcd.setCursor(16,0);
  lcd.print(t_set);
  lcd.setCursor(0,2);
  lcd.print("Mot.Speed: 100");//11,2 - Motor speed
  lcd.setCursor(11,2);
  lcd.print(motor_speed);

  btn[0].setPins(INPUT_PULLUP, PD2);
  btn[1].setPins(INPUT_PULLUP, PD3);
  btn[2].setPins(INPUT_PULLUP, PD4);
  Serial.begin(115200);
}

void change_params(int save, int plus){
    //change current temperature
    if (save==0){
      if (plus==1){
        t_current_temp++;
      }
      if (plus==0){
        t_current_temp--;
      }      
      if (t_current>=300 || t_current<=0){
        //stop heating
      }
      lcd.noBlink();
      lcd.noCursor();
      lcd.setCursor(4,0);
      lcd.print("   ");
      lcd.setCursor(4,0);
      lcd.print(t_current_temp);
    }
    //change needed temperature
    if (save==1){
      if (plus==1){
        t_set_temp++;
      }
      if (plus==0){
        t_set_temp--;
      }
      if (t_set_temp>=300){
        t_set_temp=300;
      }
      if (t_set_temp<=0){
        t_set_temp=0;
      }

      lcd.setCursor(16,0);
      lcd.print("   ");
      lcd.setCursor(16,0);
      lcd.print(t_set_temp);
    }
    //change motor speed
    if (save==2){
      if (plus==1){
        motor_speed_temp++;
      }
      if (plus==0){
        motor_speed_temp--;
      } 
      if (motor_speed_temp>=255){
        motor_speed_temp=255;
      }
      if (motor_speed_temp<=-255){
        motor_speed_temp=-255;
      }

      lcd.setCursor(11,2);
      lcd.print("   ");
      lcd.setCursor(11,2);
      lcd.print(motor_speed_temp);
    }
}

void loop()
{ 
  unsigned long currentMillis = millis();
  
  //проверяем не прошел ли нужный интервал, если прошел то
  if(currentMillis - previousMillis > interval) {
    // сохраняем время последнего переключения
    previousMillis = currentMillis; 
    change_params(0,100);  
  }

  filT += (therm.getTemp() - filT) * 0.1;
  t_current_temp=filT;
  //therm.getTempAverage();
  
  if (save==100){
    lcd.noBlink();
    lcd.cursor();
  }
  for (int i = 0; i < BTN_AMOUNT; i++) btn[i].tick();
  //moving cursor
  //if (cursor==0){
  //    lcd.setCursor(3, 0);
  //}
  if (cursor==1){
      lcd.setCursor(15, 0);
  }
  if (cursor==2){
      lcd.setCursor(10, 2);
  }
    //listen button held
  if (btn[0].held()) {
    Serial.println("hold enter");
    //enter change mode
    if (save==100){
      Serial.println("hold enter and save==100");
      save=cursor;
      lcd.blink(); 
      lcd.cursor();
    }else{
      //enter save mode
      // if(save==0){
      //   Serial.println("hold enter and save==0");
      //   t_current=t_current_temp;
      //   lcd.setCursor(4,0);
      //   lcd.print("   ");
      //   lcd.setCursor(4,0);
      //   lcd.print(t_current);
      //   lcd.cursor();
      //   lcd.blink();
      //   delay(3000);
      // }
      if(save==1){
        Serial.println("hold enter and save==1");
        t_set=t_set_temp;
        lcd.setCursor(16,0);
        lcd.print("   ");
        lcd.setCursor(16,0);
        lcd.print(t_set);
        lcd.cursor();
        lcd.blink();
        delay(3000);
      }
      if(save==2){
        Serial.println("hold enter and save==2");
        motor_speed=motor_speed_temp;
        lcd.setCursor(11,2);
        lcd.print("   ");
        lcd.setCursor(11,2);
        lcd.print(motor_speed);
        lcd.cursor();
        lcd.blink();
        delay(3000);
      }
      lcd.noBlink(); 
      lcd.cursor();
      //lcd.blink();
      save=100;
    } 
  }
  //listen button click
  if (btn[0].click()) {
    Serial.println("press enter");
    if(save!=100){
      save=100;
      t_current_temp=t_current;
      t_set_temp=t_set;
      motor_speed_temp=motor_speed;
      lcd.setCursor(4,0);
      lcd.print("   ");
      lcd.setCursor(4,0);
      lcd.print(t_current);
      lcd.setCursor(16,0);
      lcd.print("   ");
      lcd.setCursor(16,0);
      lcd.print(t_set);
      lcd.setCursor(11,2);
      lcd.print("   ");
      lcd.setCursor(11,2);
      lcd.print(motor_speed);
    }
    cursor++;
    if (cursor>2){
      cursor=1;
    }
  }  
  if (btn[1].click() && save!=100) {
    Serial.println("press right and save!=100");
    change_params(save,1);  
  } 
  if (btn[2].click() && save!=100) {
    Serial.println("press left and save!=100");
    change_params(save,0);  
  } 

}