#include <FR_Infrared.h>

#include <FR_DCMotor.h>

int _E6_AC_A1_E6_95_B8;

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_left() {
  DC_motor_port_m1.rotate('F',120);
  DC_motor_port_m2.rotate('F',120);
}

// 前進
void Forward() {
  DC_motor_port_m1.rotate('R',120);
  DC_motor_port_m2.rotate('F',120);
}

// 後退
void backward() {
  DC_motor_port_m1.rotate('F',120);
  DC_motor_port_m2.rotate('R',120);
}

// 右轉
void turn_right() {
  DC_motor_port_m1.rotate('R',120);
  DC_motor_port_m2.rotate('R',120);
}

// 停止
void stop() {
  DC_motor_port_m1.rotate('S',255);
  DC_motor_port_m2.rotate('S',255);
}

void setup()
{
  stop();
  delay(1000);
}

void loop()
{
  Forward();
  if  (IR_port_01.getValue('L') == 1 && IR_port_01.getValue('R') == 1) {
    backward();
    delay(50);

  }
  if (IR_port_01.getValue('L') == 1 && IR_port_01.getValue('R') == 0) {
    turn_right();
    delay(50);

  }
  if (IR_port_01.getValue('L') == 0 && IR_port_01.getValue('R') == 1) {
    turn_left();
    delay(50);

  }

}