Em hãy viết chương trình mở rộng yêu cầu của chương trình minh họa trong Mục 2, yêu cầu robot xử lý vật cản như sau:

- Nếu gặp phải vật cản thứ nhất sẽ rẽ trái.

- Nếu gặp phải vật cản thứ hai sẽ rẽ phải.

- Nếu gặp phải vật cản thứ ba thì xoay 180 độ đi theo chiều ngược lại.

- Nếu gặp phải các vật cản tiếp theo thì lặp lại yêu cầu như trên: robto rẽ trái, sau đó rẽ phải, sau đó xoay để đi ngược lại nếu gặp các vật cản tiếp theo.

Một robot hút bụi thường được tích hợp nhiều loại cảm biến như: Cảm biến hồng ngoại giúp robot không bị rơi khi ở gần cầu thang, cảm biến siêu âm giúp robot chống va đạp vào tường…

Cảm biến siêu âm vẫn hoạt động theo nguyên lý phát sóng siêu âm liên tục cho đến khi phát hiện vật cản trong khoảng đo đã được lập trình thì điều khiển robot hút bụi tránh vật cản.

Nguyên tắc hoạt động của cảm biến siêu âm:

Mỗi cảm biến siêu âm chỉ có tác dụng trong một khoảng cách nhất định. Gọi khoảng cách này là Max. Khi vật cản ở xa, vượt qua giới hạn Max, có thể coi hàm nhận tín hiệu cảm biến sẽ trả về giá trị Max. Cảm biến siêu âm dựa trên nguyên lý phát sóng và phản xạ sóng siêu âm.

Lệnh lập trình cảm biến siêu âm:

Câu lệnh lập trình cảm biến siêu âm luôn trả về giá trị là khoảng cách từ cảm biến siêu âm đến vật cản phía trước theo đơn vị centimet.

Để robot nhận được tín hiệu cảm biến siêu âm liên tục với thời gian thực chúng ta cần đưa lệnh điều khiển cảm biến siêu âm vào trong nhóm lệnh thứ hai, tức là nhóm lệnh lặp vô hạn trong chương trình.

Sơ đồ chung của việc xử lí thông tin cảm biến siêu âm của robot:

forever

if <nhận tín hiệu cảm biến siêu âm>

Xử lí tín hiệu cảm biến siêu âm