As the title said, i have build-ed the $50 robot, and i would like to add 3 more photo sensors, for some reason 4 sensors wont work and it's not the connection. using led as indicator of input/controle change.
My edited code:
/*********ADD YOUR CODE BELOW THIS LINE **********/
LED_on();//turn LED on
while(1)
{
//store sensor data
sensor_front_left=a2dConvert8bit(5);
sensor_front_right=a2dConvert8bit(4);
sensor_right=a2dConvert8bit(3);
sensor_left=a2dConvert8bit(2);
sensor_ass=a2dConvert8bit(1);
//detects light infront of robot
if(sensor_front_left = sensor_front_right && (sensor_front_left = sensor_front_right) > threshold)
{ //If front sensors are equal on light, go straight
LED_off();
servo_left(25);
servo_right(44);
LED_on();
}
//detects more light on left side of robot
else if(sensor_left > sensor_front_left && (sensor_left - sensor_front_left) > threshold)
{//go left
LED_off();
servo_left(44);
servo_right(44);
LED_on();
}
//detects more light on right side of robot
else if(sensor_right > sensor_front_right && (sensor_right - sensor_front_right) > threshold)
{//go right
LED_off();
servo_left(25);
servo_right(25);
LED_on();
}
//detects light behind robot
else if(sensor_ass > sensor_front_left && sensor_ass > sensor_front_right && sensor_ass > sensor_right && sensor_ass > sensor_left > threshold)
{//go back
LED_off();
servo_left(44);
servo_right(25);
LED_on();
}
The back (ass) sensor is tenth for driving back if it accidently drove in a dark space.
ANy programming ideas?