#include <AFMotor.h>
AF_DCMotor motor1(1);
AF_DCMotor motor2(2);
int IR1=A0;
int IR2=A1;
void setup()
{
motor1.setSpeed(255); //1R MOTORIIN HURD
motor2.setSpeed(168); //2R MOTORIIN HURD
pinMode(A0, INPUT);
pinMode(A1, INPUT);
Serial.begin(9600);
}
void loop()
{
int l = digitalRead(IR1);
int r = digitalRead(IR2);
Serial.print("Sensor Value: ");
Serial.print(l); Serial.print('-'); Serial.println(r);
if((l==1)&&(r==1)){uragshaa();}
else if((l==0)&&(r==0)){uragshaa();}
else if((l==1)&&(r==0)){baruun();}
else if((l==0)&&(r==1)){zuun();}
}
void uragshaa()
{
motor1.run(FORWARD);
motor2.run(FORWARD);
}
void hoishoo() {
motor1.run(BACKWARD);
motor2.run(BACKWARD);
}
void zogs() {
motor1.run(RELEASE);
motor2.run(RELEASE);
}
void baruun() {
motor1.run(FORWARD);
motor2.run(RELEASE);
}
void zuun() {
motor1.run(RELEASE);
motor2.run(FORWARD);
}
No comments:
Post a Comment