//Touch sensor robot
//Team B
//sensors
#define FRONT_TOUCH_SENSOR 2
#define BACK_TOUCH_SENSOR 3
//motors
#define RIGHT_MOTOR A
#define LEFT_MOTOR C
void main()
{
while (1)
fd(RIGHT_MOTOR);
fd (LEFT_MOTOR);
while (touch (FRONT_TOUCH_SENSOR) == 0)
{
printf ("n/a") ;
}
off (RIGHT_MOTOR) ;
off (LEFT_MOTOR) ;
beep () ;
printf ("OUCH!!!!!") ;
{
bk (RIGHT_MOTOR) ;
bk (LEFT_MOTOR) ;
sleep (2.0);
}
{ while (touch (BACK_TOUCH_SENSOR) == 0)
{
printf ("n/a") ;
}
off (RIGHT_MOTOR) ;
off (LEFT_MOTOR) ;
beep () ;
printf ("OUCH!!!!!") ;
}
}