초음파 센서를 사용하여 로봇이 직진 하다가 물체가 감지되면 정지하는 동작을 코딩해 봅시다.
void loop(void){
if(sonic_read(LL) <= 150)
wheel(0,0);
else
wheel(5,5);
}
https://youtube.com/shorts/l9b-zVcsrh4?feature=share
10cm보다 가까우면 후진하고 15cm보다 멀리 있으면 직진하고 10cm~15cm사이면 정지하도록 해 봅시다.
if(sonic_read(LL) <= 100)
wheel(-5,-5);
else if(sonic_read(LL) <= 150)
wheel(0,0);
else
wheel(5,5);
초음파센서가 15cm 보다 멀리 감지되면 직진
만약 15cm보다 가까이 감지되면 motor 함수를 사용하여 일정시간 후진, 일정시간 회전
위 동작을 무한 반복