                  red  - 5v
                  white- ir(A5)
                  
-Motor setup:    ask AC
+Motor setup:    motor
 
 Photores setup:  power- 5v
                  gnd  - gnd

 
void setup() 
{ 
  myservo.attach(servoPin); // attaches the servo on pin 9 to the servo object 
  pinMode(ir, INPUT);
  pinMode(prLPin, INPUT);
  pinMode(prRPin, INPUT);
  Serial.begin(9600);
} 
 

const int disMin = 10;  //min value of obj to be determined "in way"

//WHEELS
//left motor
const int speedLPin = 7;    //speed pin for left motor
const int enableLForPin = 6;   //enable left forward pin
  const int enableLRevPin = 5;   //enable left forward pin 
//right motor
const int speedR = 4;    //speed pin for right motor
const int enRFor = 3;   //controller pin 1 for right motor
const int enRRev = 2;   //controller pin 2 for right motor

int wheelTurn = 0; //Magnitude of turn, I guess could be difference of wheels
                   //(- is left and + is right and 0 is straight)
int wheelSpeed = 0;    //speed of actual robots, dependent on wheel (0-255)

//PHOTORES
const int prLPin = 10;  //pin to hook up left photoresistor to
