튜토리얼

뒤로가기
제목

아두이노 모터쉴드 활용하기 #1. PSD를 이용한 장애물탈출 로봇

작성자 (주)로보메카(ip:)

작성일 2013-01-08 16:40:19

조회 1193

평점 0점  

추천 추천하기

내용

 

 

[주요부품]

- Arduino Uno

- Motor sheild <-- 바로가기 클릭

- PSD Sensor (2Y0A21 F 08) : 2EA

- Geared DC Motor (120rpm) : 2ea

 

[소스코드] Arduino 1.0.3

 

int val1=0;
int val2=0;
int spd1=200;
int spd2=100;

void setup()
{
  pinMode(14, INPUT);
  pinMode(3, OUTPUT);
  pinMode(5, OUTPUT);
  pinMode(6, OUTPUT);
  pinMode(9, OUTPUT);
 
}

void loop()
{
  val1 = analogRead(A0);
  val2 = analogRead(A1);
  if(val1>=650)
  {
    left();
    delay(500);
  }
  else if(val1<=200)
  {
    left();
    delay(500);
  } 
  else if(val2>=650)
  {
    left();
  } 
  else if(val2<=200)
  {
    left();
  } 
  else rturn();
   
}

void rturn()
{
  analogWrite(5,spd1);
  analogWrite(6,spd2);
  analogWrite(3,0);
  analogWrite(9,0);
}

void left()
{
  analogWrite(3,spd2);
  analogWrite(6,spd2);
  analogWrite(5,0);
  analogWrite(9,0);

}

첨부파일 2013-01-08 15.39.10.jpg , 2013-01-08 15.39.29.jpg

비밀번호
수정

비밀번호 입력후 수정 혹은 삭제해주세요.

댓글 수정

이름

비밀번호

내용

/ byte

수정 취소

비밀번호

확인 취소