Robot To Move in Rectangle
Robot To Move in Rectangle
#define ldir 29
#define rdir 30
#define lspd 40
#define rspd 39
#define lslp 31
#define rslp 11
void setup(){
// put your setup code here, to run once:
pinMode(ldir,OUTPUT);
pinMode(rdir,OUTPUT);
pinMode(lspd,OUTPUT);
pinMode(rspd,OUTPUT);
pinMode(lslp,OUTPUT);
pinMode(rslp,OUTPUT);
digitalWrite(lslp, HIGH);
digitalWrite(rslp, HIGH);
}
void loop(){
{
// forward:
digitalWrite(ldir, LOW);
digitalWrite(rdir, LOW);
analogWrite(lspd, 100);
analogWrite(rspd, 100);
delay(2000);
}
{
// right:
digitalWrite(ldir, LOW);
digitalWrite(rdir, LOW);
analogWrite(lspd, 100);
analogWrite(rspd, 0);
delay(1000);
}
{
// forward:
digitalWrite(ldir, LOW);
digitalWrite(rdir, LOW);
analogWrite(lspd, 100);
analogWrite(rspd, 100);
delay(2000);
}
{
// right:
digitalWrite(ldir, LOW);
digitalWrite(rdir, LOW);
analogWrite(lspd, 100);
analogWrite(rspd, 0);
delay(1000);
}
{
// forward:
digitalWrite(ldir, LOW);
digitalWrite(rdir, LOW);
analogWrite(lspd, 100);
analogWrite(rspd, 100);
delay(2000);
}
{
// right:
digitalWrite(ldir, LOW);
digitalWrite(rdir, LOW);
analogWrite(lspd, 100);
analogWrite(rspd, 0);
delay(1000);
}
{
// forward:
digitalWrite(ldir, LOW);
digitalWrite(rdir, LOW);
analogWrite(lspd, 100);
analogWrite(rspd, 100);
delay(1000);
}
}
Robot to move in circle:
#define ldir 29
#define rdir 30
#define lspd 40
#define rspd 39
#define lslp 31
#define rslp 11
void setup(){
// put your setup code here, to run once:
pinMode(ldir,OUTPUT);
pinMode(rdir,OUTPUT);
pinMode(lspd,OUTPUT);
pinMode(rspd,OUTPUT);
pinMode(lslp,OUTPUT);
pinMode(rslp,OUTPUT);
digitalWrite(lslp, HIGH);
digitalWrite(rslp, HIGH);
}
void loop(){
{
// forward:
digitalWrite(ldir, LOW);
digitalWrite(rdir, LOW);
analogWrite(lspd, 100);
analogWrite(rspd, 50);
delay(1000);
}
}