Терминатор

ROB-26586

Робот для езды по узкой черной линии использует три инфракрасных датчика плотно прижатых к поверхности поля. Ширина каждого датчика равна ширине линии.

Когда линия находится под центральным датчиком робот едет вперед, когда под левым датчиком - робот поворачивает вправо, когда под правым - влево.

Робот создан из конструктора Huna. Конструкция скреплена. Состоит из материнской платы, небольшого отсека для батареек, 2 моторов и 3 инфракрасных датчика. провода хорошо соединены, конструкция сделана по размерам 26х20. Сначала был создан корпус, а потом моторы. Самыми последними я прикрепил датчики и моторы. Я думаю что этот робот должен пройти черную линию. Данный робот несколько раз перестраивался.

Пример программы представлен ниже


while(1)
{
if(ir(1,950,SENSE)==TRUE&&ir(2,0,NONE)==TRUE&&ir(3,950,SENSE)==TRUE)
{
dc_motor(LEFT_MOTOR_1,FORWARD_DIRECTION,10);
dc_motor(RIGHT_MOTOR_1,FORWARD_DIRECTION,10);
}
if(ir(1,950,SENSE)==TRUE&&ir(2,950,SENSE)==TRUE&&ir(3,0,NONE)==TRUE)
{
dc_motor(LEFT_MOTOR_1,FORWARD_DIRECTION,10);
dc_motor(RIGHT_MOTOR_1,BACKWARD_DIRECTION,-10);
}
if(ir(1,0,NONE)==TRUE&&ir(2,950,SENSE)==TRUE&&ir(3,950,SENSE)==TRUE)
{
dc_motor(LEFT_MOTOR_1,BACKWARD_DIRECTION,-10);
dc_motor(RIGHT_MOTOR_1,FORWARD_DIRECTION,10);
}
}