#include <FR_Infrared.h>
#include <FR_DCMotor.h>
FR_Infrared IR_port_01(A1,A7);
FR_DCMotor DC_motor_port_m1(3,11);
FR_DCMotor DC_motor_port_m2(6,5);
// 右轉
void Turn_right() {
DC_motor_port_m1.rotate('R',150);
DC_motor_port_m2.rotate('S',0);
}
// 左轉
void Turn_left() {
DC_motor_port_m2.rotate('S',0);
DC_motor_port_m2.rotate('F',150);
}
void setup()
{
}
void loop()
{
if (IR_port_01.getValue('L') == 1) { //當左側紅外線感應器為白色
Turn_right(); //執行右轉
delay(5); //延遲 5 毫秒
}
if (IR_port_01.getValue('L') == 0) { //當左側紅外線感應器為黑色
Turn_left(); //執行左轉
delay(5); //延遲 5 毫秒
}
|