라즈봇 초음파 센서 테스트 Yahboom 자율주행차

거리 측정

Trig는 16번, Echo는 18번 핀에 접속 실행하면 앞에 있는 장애물과의 거리를 출력한다.

경고음을 울리기 위한 코드에 있는 Distance( )와 Distance_test() 함수는 그대로 사용하면서 장애물이 15cm 안쪽으로 들어가면 짧게 부저를 울리는 코드를 추가한다.

회피 모드 장애물이 15cm 안쪽으로 들어가면 turn하고 회피 요구르트 avoid( ) 추가. 거리가 15cm 이내라면 차이를 정치하고 오른쪽 스핀. 그렇지 않은 경우는 단지 run, run, run

error: Content is protected !!