AVR

모터테스트

by 디케 posted Aug 25, 2012
?

단축키

Prev이전 문서

Next다음 문서

ESC닫기

크게 작게 위로 아래로 댓글로 가기 인쇄


모터테스트


#include <SoftwareSerial.h>

SoftwareSerial BTserial(2,3);    //블루투스 모듈 통신 설정

int a = 0;

void setup(){

  BTserial.begin(115200);      //블루투스 모듈 통신 시작

}


void loop(){

    a = BTserial.read();      // 스마트폰에서 블루투스 모듈로 들어오는 신호를 a에 저장

    switch (a){

      

      case 2:

        analogWrite(5,250);        // 왼쪽 모터 전진 정보 핀

        analogWrite(7,0);        // 왼쪽 모터 후진 정보 핀

        delay(20);

        break;

        

      case 0:               // 0이면 정지

        analogWrite(8,0);        // 왼쪽 모터 전진 정보 핀

        analogWrite(9,0);        // 왼쪽 모터 후진 정보 핀

        analogWrite(10,0);       // 오른쪽 모터 전진 정보 핀

        analogWrite(11,0);       // 오른쪽 모터 후진 정보 핀

        delay(30); break;

      case 4:               // 4면 제자리 좌회전

        analogWrite(8,0);

        analogWrite(9,250);

        analogWrite(10,250);

        analogWrite(11,0);

        delay(20);

        break;

      case 8:               // 8이면 제자리 우회전

        analogWrite(8,250);

        analogWrite(9,0);

        analogWrite(10,0);

        analogWrite(11,250);

        delay(20);

        break;     

      case 16:               // 16이면 전진

        analogWrite(8,250);

        analogWrite(9,0);

        analogWrite(10,250);

        analogWrite(11,0);

        delay(20);

        break;

      case 20:               // 20이면 좌회전

        analogWrite(8,0);

        analogWrite(9,0);

        analogWrite(10,250);

        analogWrite(11,0);

        delay(20);

        break;

      case 24:                // 24이면 우회전

        analogWrite(8,250);

        analogWrite(9,0);

        analogWrite(10,0);

        analogWrite(11,0);

        delay(20);

        break;

      case 32:                // 32이면 후진

        analogWrite(8,0);

        analogWrite(9,250);

        analogWrite(10,0);

        analogWrite(11,250);

        delay(20);

        break;   

    }

}