int Lspeed = 0; //Скорость левый мотор
int Rspeed = 0; //Скорость правый мотор
bool Lcourse = 1; //Направление левый мотор
bool Rcourse = 1; //Направление правый мотор
void setup() {
// Инициализируем порты для моторов
pinMode(4, OUTPUT);
pinMode(5, OUTPUT); // Правый
pinMode(6, OUTPUT); // Левый
pinMode(7, OUTPUT);
// Инициализируем порты для датчиков линии
pinMode(12, INPUT); // Левый
pinMode(A0, INPUT); // Правый
}
void loop() {
// Считываем значения датчиков линии
bool LSensor = digitalRead(12);
bool RSensor = digitalRead(A0);
// Левый датчик не на линии?
if(LSensor == LOW)
{
Lspeed = 70;
}
else
{
Lspeed = 0;
}
// Правый датчик не на линии?
if(RSensor == LOW)
{
Rspeed = 70;
}
else
{
Rspeed = 0;
}
// Применение скорости и направления.
analogWrite(5, Rspeed);
digitalWrite(4, Rcourse);
analogWrite(6, Lspeed);
digitalWrite(7, Lcourse);
}