L239D 모터쉴드 DC모터 구동 RC카 앱 인벤터 블루투스 제어 아두이노 코드

AFMotor.h 라이브러리

adafruit-Adafruit-Motor-Shield-library-1.0.0-3-g99381df.zip

FOF4YFTIA0WX947_F_BT_01

#include <AFMotor.h>
AF_DCMotor motor1(3);
AF_DCMotor motor2(4);
int mspd = 120;
char command;

void setup() {      
  Serial.begin(9600); 
  Stop();
}

void loop(){
 if(Serial.available() > 0){
    command = Serial.read();
     if( command == 'F') {
      forward();
      delay(1000);
     }

     if( command == 'B') {
      back();
      delay(1000);
     }

     if( command == 'L') {
      left();
      delay(1000);
     }

     if( command == 'R') {
      right();
      delay(1000);
     }

     if( command == 'S') {
      Stop();
      delay(1000);
     }
 }
}

void forward()  {
  motor1.setSpeed(mspd); //Define maximum velocity
  motor1.run(FORWARD); //rotate the motor clockwise
  motor2.setSpeed(mspd); //Define maximum velocity
  motor2.run(FORWARD); //rotate the motor clockwise
}

void back()  {
  motor1.setSpeed(mspd);
  motor1.run(BACKWARD); //rotate the motor counterclockwise
  motor2.setSpeed(mspd);
  motor2.run(BACKWARD); //rotate the motor counterclockwise
}

void left()  {
  motor1.setSpeed(mspd); //Define maximum velocity
  motor1.run(FORWARD); //rotate the motor clockwise
  motor2.setSpeed(0);
  motor2.run(RELEASE); //turn motor2 off
}

void right()  {
  motor1.setSpeed(0);
  motor1.run(RELEASE); //turn motor1 off
  motor2.setSpeed(mspd); //Define maximum velocity
  motor2.run(FORWARD); //rotate the motor clockwise
}

void Stop()  {
  motor1.setSpeed(0);
  motor1.run(RELEASE); //turn motor1 off
  motor2.setSpeed(0);
  motor2.run(RELEASE); //turn motor2 off
}

//끝

adafruit-Adafruit-Motor-Shield-library-1.0.0-3-g99381df.zip

0.01MB