Em hãy viết chương trình điều khiển robot dò đường đi vòng quanh sa bàn, nếu gặp vật cản thì bật còi
Em hãy viết chương trình điều khiển robot dò đường đi vòng quanh sa bàn, nếu gặp vật cản thì bật còi, bật đèn LED đỏ ở cổng 1 trong suốt thời gian có vật cản phía trước. Robot rẽ trái để tránh vật cản, khi vật cản đã ở xa thì bật đèn LED xanh lá cây ở cổng 2 trong 1 giây báo hiệu an toàn.
Trả lời:
Chương trình có thể viết dưới dạng pseudocode như sau:
Khởi động chương trình
forever
if Tín hiệu dò đường(<<trái>>, cổng)=0 and Tín hiệu dò đường(<<phải>>, cổng)=0
Đi thẳng (100)
if Tín hiệu dò đường(<<trái>>, cổng)=0 and Tín hiệu dò đường(<<phải>>, cổng)=1
Xoay trái (70)
if Tín hiệu dò đường(<<trái>>, cổng)=1 and Tín hiệu dò đường(<<phải>>, cổng)=0
Xoay phải (70)
if Tín hiệu dò đường(<<trái>>, cổng)=1 and Tín hiệu dò đường(<<phải>>, cổng)=1
Xoay trái (70)
While Tín hiệu cảm biến siêu âm (cppngr) <= 5
Bật còi
Bật đèn LED (1,255)
Xoay trái (70)
Wait until Tín hiệu cảm biến siêu âm (cổng) > 5
Tắt đèn LED (1)
Bật đèn LED (2,255)
Đợi 1 giây
Tắt đèn LED (2)
Bình luận