#include <Arduino.h>
#include <Servo.h>

#define MOTOR_1_PIN 5   // Pin ESC silnika 1
#define MOTOR_2_PIN 6   // Pin ESC silnika 2
#define BALL_DETECT 11  // Krańcówka

// Wartości PWM dla ESC
#define SPEED_MIN 0
#define SPEED_MAX 180

Servo motor_1;
Servo motor_2;

void setup()
{
    pinMode(BALL_DETECT, INPUT_PULLUP);
    motor_1.attach(MOTOR_1_PIN);
    motor_2.attach(MOTOR_2_PIN);
}

void loop()
{
    if (digitalRead(BALL_DETECT))
    {
        motor_1.write(SPEED_MIN);
        motor_2.write(SPEED_MIN);
    }
    else
    {
        motor_1.write(SPEED_MAX);
        motor_2.write(SPEED_MAX);
    }
}