본문 바로가기
프로그래밍/아두이노

아두이노 DC모터 움직이기

by -현's- 2016. 1. 5.
반응형


배터리연결

빨간 + 

검정 -






#include <AFMotor.h>

#include <SoftwareSerial.h>

byte INBYTE;

SoftwareSerial BTSerial(3, 2); //Connect HC-06 TX,RX

AF_DCMotor motor1(1);

AF_DCMotor motor2(3);


void setup() {

  Serial.begin(9600);           // set up Serial library at 9600 bps

  Serial.println("Motor test!");

  BTSerial.begin(9600);//블루투스 연결

  // turn on motor

  motor1.setSpeed(200);

  motor2.setSpeed(200);

  motor1.run(RELEASE);

  motor2.run(RELEASE);

}


void loop() {

  uint8_t i;

 if (BTSerial.available()){

    INBYTE = BTSerial.read();  

    Serial.println(INBYTE);

    switch(INBYTE){

      case 'a':

        motor1.setSpeed(200);  

        motor1.run(FORWARD);

        motor2.setSpeed(200);  

        motor2.run(FORWARD);

        break;

      case 'b':

        motor1.setSpeed(200);  

        motor1.run(BACKWARD);

        motor2.setSpeed(200);  

        motor2.run(BACKWARD);

        break;

      case 'c':

        motor1.run(RELEASE);  

        motor2.run(RELEASE);  

      break;

    }

  }


}







반응형

댓글