// Jose Edson-Robotics Arms:

#include <ESP32Servo.h>
#include <time.h> 
#include <LiquidCrystal_I2C.h>
LiquidCrystal_I2C LCD = LiquidCrystal_I2C(0x27, 16, 2);
int colunas = 16;
int linhas = 2;


# define pot1 36
# define pot2 4
# define pot3 15
# define pot4 32
# define pot5 33
# define pot6 34


const int buzzer = 13;

int led1 = 12;
int led2 = 2;
int led3 = 15;
int freq = 440;

Servo s1 ,s2 ,s3 ,s4 ,s5 ,s6 ;
int main();
int ang1, ang2, ang3, ang4, ang5, ang6 ;
int tmp=1000;


void setup() {
    
    s1.attach(5);
    s2.attach(25);
    s3.attach(26);
    s4.attach(27);
    s5.attach(14);
    s6.attach(19);
    
  

    Serial.begin(115200);
    
  pinMode (led1, OUTPUT);
  pinMode (led2, OUTPUT);
  pinMode (led3, OUTPUT);
  pinMode(buzzer, OUTPUT);
  
  
  
  LCD.init();
  LCD.backlight();
  
    }
  
  void loop()
  {

  float ang1 = analogRead(pot1)*(180.0/4095.0);
  float ang2 = analogRead(pot2)*(180.0/4095.0);
  float ang3 = analogRead(pot3)*(180.0/4095.0);
  float ang4 = analogRead(pot4)*(180.0/4095.0);
  float ang5 = analogRead(pot5)*(180.0/4095.0);
  float ang6 = analogRead(pot6)*(180.0/4095.0);
  
      
  
  s1.write(ang1);
  
  Serial.println(ang1);
  LCD.setCursor(0, 0);
  LCD.print("Ang1: ");
  LCD.setCursor(10, 0);
  LCD.print(ang1);
  LCD.setCursor(14, 0);
  LCD.print(" G");
  LCD.setCursor(0, 1);
  delay (100);
  LCD.print("By Eng JoseEdson");
  delay (2000);
  LCD.clear();
  

  
  s2.write(ang2);
  
  Serial.println(ang2);
  LCD.setCursor(0, 0);
  LCD.print("Ang2: ");
  LCD.setCursor(10, 0);
  LCD.print(ang2);
  LCD.setCursor(14, 0);
  LCD.print(" G");
  LCD.setCursor(0, 1);
  delay (100);
  LCD.print("By Eng JoseEdson");
  delay (2000);
  LCD.clear();
  


  s3.write(ang3);
  
  Serial.println(ang3);
  LCD.setCursor(0, 0);
  LCD.print("Ang3: ");
  LCD.setCursor(10, 0);
  LCD.print(ang3);
  LCD.setCursor(14, 0);
  LCD.print(" G");
  LCD.setCursor(0, 1);
  delay (100);
  LCD.print("By Eng JoseEdson");
  delay (2000);
  LCD.clear();
 


  s4.write(ang4);
  
  Serial.println(ang4);
  LCD.setCursor(0, 0);
  LCD.print("Ang4: ");
  LCD.setCursor(10, 0);
  LCD.print(ang4);
  LCD.setCursor(14, 0);
  LCD.print(" G");
  LCD.setCursor(0, 1);
  delay (100);
  LCD.print("By Eng JoseEdson");
  delay (2000);
  LCD.clear();
  



  s5.write(ang5);
  
  Serial.println(ang5);
  LCD.setCursor(0, 0);
  LCD.print("Ang5: ");
  LCD.setCursor(10, 0);
  LCD.print(ang5);
  LCD.setCursor(14, 0);
  LCD.print("G");
  LCD.setCursor(0, 1);
  delay (100);
  LCD.print("By Eng JoseEdson");
  delay (2000);
  LCD.clear();
  


  s6.write(ang6);
  
  Serial.println(ang6);
  LCD.setCursor(0, 0);
  LCD.print("Ang6: ");
  LCD.setCursor(10, 0);
  LCD.print(ang6);
  LCD.setCursor(14, 0);
  LCD.print("G");
  LCD.setCursor(0, 1);
  delay (100);
  LCD.print("By Eng JoseEdson");
  delay (2000);
  LCD.clear();
 
   
   
  }