#include <FR_DCMotor.h>
#include <FR_UltraSonic.h>
FR_DCMotor DC_motor_port_m1(3,11);
FR_DCMotor DC_motor_port_m2(6,5);
// 前進
void forward() {
DC_motor_port_m1.rotate('R',255);
DC_motor_port_m2.rotate('F',255);
}
// 右轉
void turn_right() {
DC_motor_port_m1.rotate('R',255);
DC_motor_port_m2.rotate('S',0);
}
FR_UltraSonic US_port_03(A0);
void setup()
{
}
void loop()
{
forward();
if (US_port_03.getValue() <= 15) { //如果超音波在15cm內接收到障礙物
turn_right(); //執行 turn_right
delay(500); //動作持續0.5 秒
}
}
|