#include<Arduino.h>
#include <ESP32Servo.h>

Servo handServo;
Servo boxServo;

const int handServopin = 33;
const int boxServopin = 32;


void setup() {
  handServo.setPeriodHertz(50);
  handServo.setPeriodHertz(50);

  handServo.attach(handServopin, 500, 2400);
  boxServo.attach(boxServopin, 500, 2400);

  xTaskCreatePinnedToCore(
    task1,
    "Hand Servo",
    1000,
    NULL,
    1,
    NULL,
    0
  );

  xTaskCreatePinnedToCore(
    task2,
    "Box Servo",
    1000,
    NULL,
    1,
    NULL,
    1
  );
}

void task1( void * parameters) {
  while(true){
    digitalWrite(19, HIGH);
  vTaskDelay(200 / portTICK_PERIOD_MS);
  digitalWrite(19, LOW);
  vTaskDelay(200 / portTICK_PERIOD_MS);
  }
  vTaskDelete(NULL); 

}

void task2( void * parameters) {
  while(true){
  digitalWrite(18, HIGH);
  vTaskDelay(200 / portTICK_PERIOD_MS);
  digitalWrite(18, LOW);
  vTaskDelay(200 / portTICK_PERIOD_MS);
  }
  vTaskDelete(NULL); 

}
void loop() {


}