#define left_line 6
#define right_line 7
#define M11 4
#define M12 5
#define M21 8
#define M22 9
#include <Ultrasonic.h>
Ultrasonic dalnomer (12, 13);
float distance;
void setup() {
Serial.begin(9600);
}
void loop() {
int l = digitalRead(left_line);
int r = digitalRead(right_line);
if (r == 1 && l == 0){Right(50);}
if (r == 0 && l == 1){Left(50);}
if (r == 0 && l == 0){Forward(50);}
if (r == 1 && l == 1){Forward(50);}
}
void Forward(int Speed){
analogWrite(M12,LOW);
analogWrite(M21,Speed);
analogWrite(M11,Speed);
analogWrite(M22,LOW);
}
void Back(int Speed){
analogWrite(M12,Speed);
analogWrite(M21,LOW);
analogWrite(M11,LOW);
analogWrite(M22,Speed);
}
void Left(int Speed){
analogWrite(M12,LOW);
analogWrite(M21,LOW);
analogWrite(M11,Speed);
analogWrite(M22,Speed);
}
void Right(int Speed){
analogWrite(M12,Speed);
analogWrite(M21,Speed);
analogWrite(M11,LOW);
analogWrite(M22,LOW);
}
void Stop(){
analogWrite(M12,LOW);
analogWrite(M21,LOW);
analogWrite(M11,LOW);
analogWrite(M22,LOW);
}