hi , i have problem my project is robot follow people (tracking) by using pair of pololu IR becon ,but after download code on arduino , a robot does not move forward and back ,only Tire is move left and right ,anyone can help me please .
this is my code i hope get help:
Preformatted text
#include "ArduinoMotorShieldR3.h"
ArduinoMotorShieldR3 md;
#define NORTH A38
#define SOUTH A36
#define EAST A34
#define WEST A32
int NORTH =0;
int SOUTH =0;
int EAST =0;
int WEST =0;
void setup() {
Serial.begin(9600);
pinMode(NORTH,INPUT);
pinMode(SOUTH,INPUT);
pinMode(EAST,INPUT);
pinMode(WEST,INPUT);
md.init();
}
void loop() {
SCANDIRECTION();
WHICHDIRECTION();
delay(1000);
Serial.println(analogRead(A38));
Serial.println(analogRead(A36));
Serial.println(analogRead(A34));
Serial.println(analogRead(A32));
delay(2000);}
void WHICHDIRECTION( ){
if (NORTH < 900 && SOUTH > 500 && EAST > 500 && WEST > 500)
{ md.setSpeeds(200,200); }
else if (NORTH > 500 && SOUTH < 900 && EAST > 500 && WEST > 500)
{ md.setSpeeds(-200,-200);}
else if (NORTH > 500 && SOUTH > 500 && EAST < 900 && WEST > 500)
{ md.setSpeeds(200,0); }
else if (NORTH > 500 && SOUTH > 500 && EAST > 500 && WEST < 900)
{ md.setSpeeds(0,200); }
}
void SCANDIRECTION(){
NORTH = analogRead(A38);
SOUTH = analogRead(A36);
EAST = analogRead(A34);
WEST = analogRead(A32);}`Preformatted text`