// UCOK --------- 25 Oktober 2020
//
int maxval = 0;
uint32_t lastSample = 0;

int period = 1000;
unsigned long time_now = 0;
boolean kecil_selesai;
boolean sedang_selesai;
boolean besar_selesai;

#include <Servo.h>
Servo myservo;
Servo myservo2;
float databaru;
float dataMax;
float dataMin;
#include <HX711_ADC.h>
#include <EEPROM.h>

int statusalat =0; //0 = Kosong, 1 = Kecil, 2 = Sedang, 3= Besar
const int HX711_dout = A4; //mcu > HX711 dout pin
const int HX711_sck = A5; //mcu > HX711 sck pin

//HX711 constructor:
HX711_ADC LoadCell(HX711_dout, HX711_sck);

const int calVal_eepromAdress = 0;
long t;

boolean bol_terseleksi;
float berat_terakhir =0;
float berat_sekarang =0;

/*define the sensor's pins*/
uint8_t trigPin = 3;
uint8_t echoPin = 2;

//pinMode(12, INPUT);
//pinMode(11, INPUT);

unsigned long timerStart = 0;
int TIMER_TRIGGER_HIGH = 10;
int TIMER_LOW_HIGH = 2;

float timeDuration, distance;

float tinggipermukaan = 10.50;
/*The states of an ultrasonic sensor*/
enum SensorStates {
  TRIG_LOW,
  TRIG_HIGH,
  ECHO_HIGH
};

SensorStates _sensorState = TRIG_LOW;

void startTimer() {
  timerStart = millis();
}

bool isTimerReady(int mSec) {
  return (millis() - timerStart) < mSec;
}







void setup() {
  sedang_selesai==true;
  besar_selesai==true;
  Serial.begin(57600); delay(10);
  Serial.println();
  Serial.println("Starting...");
  
  myservo.attach(10);
  myservo2.attach(9);
  pinMode(11, INPUT);// set pin as input
  pinMode(12, INPUT);// set pin as input
  pinMode(trigPin, OUTPUT);
  pinMode(echoPin, INPUT);

  tutupservo1();
  tutupservo2();
  delay (1000);
  
  bukaservo1();
  bukaservo2();
  delay(1000);

  
  LoadCell.begin();
  float calibrationValue; // calibration value (see example file "Calibration.ino")
  calibrationValue = 262.64; // uncomment this if you want to set the calibration value in the sketch
#if defined(ESP8266)|| defined(ESP32)
  //EEPROM.begin(512); // uncomment this if you use ESP8266/ESP32 and want to fetch the calibration value from eeprom
#endif
  EEPROM.get(calVal_eepromAdress, calibrationValue); // uncomment this if you want to fetch the calibration value from eeprom

  long stabilizingtime = 500; // preciscion right after power-up can be improved by adding a few seconds of stabilizing time
  boolean _tare = false; //set this to false if you don't want tare to be performed in the next step
  LoadCell.start(stabilizingtime, _tare);
  if (LoadCell.getTareTimeoutFlag()) {
    Serial.println("Timeout, check MCU>HX711 wiring and pin designations");
    while (1);
  }
  else {
    LoadCell.setCalFactor(calibrationValue); // set calibration value (float)
    Serial.println("Startup is complete");
  }
  LoadCell.tareNoDelay();
}







void loop() {




  
  static boolean newDataReady = 0;
  const int serialPrintInterval = 500; //increase value to slow down serial print activity

  // check for new data/start next conversion:
  if (LoadCell.update()) newDataReady = true;

  // get smoothed value from the dataset:
  if (newDataReady) {
    if (millis() > t + serialPrintInterval) {
      float i = LoadCell.getData();
     // Serial.print("Berat: ");
    //  Serial.println(i);
      newDataReady = 0;
      berat_sekarang = i;
      Serial.print("Berat Sekarang: "); 
      Serial.println(i);
      t = millis();

//============================================================================
   int detect1 = digitalRead(11);
   if(detect1 == LOW){
      bukaservo1();
      bukaservo2();
      Serial.print("Mulai Menimbang "); 
      dataMax = berat_sekarang; 
      Serial.print("Berat Awal: "); 
      Serial.print(berat_sekarang); 
   }
   
   int detect2 = digitalRead(12); 
   if(detect2 == LOW){
     
      
      if (berat_sekarang > dataMax) {
          dataMax = berat_sekarang;
      }else{
          dataMax = dataMax;
      }
      Serial.println("Selesai Menimbang"); 
      Serial.print("Berat Max :"); 
      Serial.println(dataMax); 
  
    

   
       
      
          if ((dataMax > 40) && (dataMax< 100)){
            Serial.print ("Sedang: ");
            tutupservo2();
            dataMax = 0;
          }
          if (dataMax > 100){
            Serial.print ("Besar ");
            tutupservo1();
            dataMax = 0;
          }
       
        
 }

   
   
        

     
    
     
   }   
  // Akhir bagian timbangan ====================================================


  
 


  

   

   
    

// Akhir sensor Infra Red =======================================================










  

      // Cek Serial Command
      if (Serial.available() > 0) {
        float i;
        char inByte = Serial.read();
        if (inByte == 't') LoadCell.tareNoDelay();
        if (inByte == 'a') bukaservo1();
        if (inByte == 'b') tutupservo1();
        if (inByte == 'c') bukaservo2();
        if (inByte == 'd') tutupservo1();
      }
    
      
      if (LoadCell.getTareStatus() == true) {
        Serial.println("Proses Kalibrasi Selesai");
      }

  } // Akhir Pembacaan Timbangan






  
  
}
// Akhir Void Loop =============================




void bukaservo1(){
  myservo.write(100);
  Serial.println ("Buka Servo_1");
}


void tutupservo1(){
  myservo.write(180);
  Serial.println ("Tutup Servo_1");
 // delay(3000);
 // myservo.write(100);
  //besar_selesai= true;
  //sedang_selesai= true;
}

void bukaservo2(){
  myservo2.write(100);
  Serial.println ("Buka Servo_2");
}

void tutupservo2(){
  myservo2.write(180);
  Serial.println ("Tutup Servo_2");
 // delay(3000);
 // myservo2.write(100);
 // sedang_selesai= true;
 //besar_selesai= true;
}