가장 쉬운 선 추종자 로봇

이 프로젝트 정보

라인 팔로워 로봇은 Hello World to Robotics Arena입니다. 이 라인 팔로워는 매우 간단하고 쉽게 로봇을 만들 수 있습니다.

코드

Arduino 기반 라인 팔로워 로봇 C/C++

/*-------입력 정의------*/#define LS 2 // 왼쪽 센서#define RS 5 // 오른쪽 센서/*-------출력 정의- -----*/#define LM1 11 // 왼쪽 모터#define LM2 10 // 왼쪽 모터#define RM1 9 // 오른쪽 모터#define RM2 6 // 오른쪽 motorvoid setup(){ pinMode(LS, INPUT); 핀모드(RS, 입력); 핀모드(LM1, 출력); 핀모드(LM2, 출력); 핀모드(RM1, 출력); pinMode(RM2, OUTPUT);}void 루프(){if((digitalRead(LS)==LOW) &&(digitalRead(RS)==LOW)) // Condition_1 stop{ MoveForward(); } if((digitalRead(LS)==HIGH) &&(digitalRead(RS)==HIGH)) //CONDITION-2 FORWRD { Stop(); } if((digitalRead(LS)==LOW) &&(digitalRead(RS)==HIGH)) // 오른쪽 { TurnLeft(); } if((digitalRead(LS)==HIGH) &&(digitalRead(RS)==LOW)) { TurnRight(); }} 무효 MoveForward(){ analogWrite(LM1, 50); 아날로그 쓰기(LM2, 0); analogWrite(RM1, 50); 아날로그 쓰기(RM2, 0); 지연(20);} 무효 TurnRight(){ analogWrite(LM1, 0); analogWrite(LM2, 60); analogWrite(RM1, 60); 아날로그 쓰기(RM2, 0); 지연(30); } 무효 TurnLeft(){ analogWrite(LM1, 60); 아날로그 쓰기(LM2, 0); 아날로그 쓰기(RM1, 0); analogWrite(RM2, 60); 지연(30);}중지 무효(){ analogWrite(LM1, 0); 아날로그 쓰기(LM2, 0); 아날로그 쓰기(RM1, 0); 아날로그 쓰기(RM2, 0); 지연(20);}

회로도