Chọn khoảng cách giữa 2 led :

Một phần của tài liệu BÁO cáo đồ án THIẾT kế hệ THỐNG cơ điện tử đề tài THIẾT kế, CHẾ tạo và điều KHIỂN ROBOT dò LINE (LINE FOLLOWING ROBOT ) (Trang 39 - 41)

Yêu cầu :

- Phạm vi hoạt động của 2 led không chồng lên nhau

- Tối thiểu sai số

Để cảm biến hoạt động tốt thì các led phải tách biệt nhau, các led không được giao thoa với nhau, vì sẽ gây nên sai số khi hoạt động. Giả sử ta đặt hai cảm biến sát nhau sao cho vùng hoạt động của chúng vừa chạm nhau như hình

Hình 4.8 : Phạm vi quét của led thu và led phát ở 2 cảm biến đặt liền kề nhau - Khoảng cách giữa 2 led phát và thu liền kề phải đảm bảo:

𝑙 ≥ ℎ ∗ 𝑡𝑎𝑛16 + ℎ ∗ 𝑡𝑎𝑛30 = 5.18𝑚𝑚

- Khoảng cách giữa 2 led trong 1 cảm biến là 3.5 mm. Do đó khoảng cách tối thiểu giữa 2 cảm biến sẽ là:

𝑑 = 𝑙 + 3.5 ≥ 8.68 𝑚𝑚

- Ngoài ra khi hoạt động sẽ có trường hợp cảm biến nằm trong vùng bất định thì giá trị analog của cảm biến đưa về sẽ như nhau. Do đó sẽ không xác định được chính xác vị trí cảm biến so với tâm đường line. Vùng bất định của cảm biến được mô tả lại như sau:

34

Hình 4.9 : Vùng bất định của cảm biến

- Trên Hình 4.7 ta thấy khi cảm biến dịch chuyển sang phải một đoạn 26-d thì luôn có 2 led nằm trong đường line, và do đó tín hiệu analog đo được sẽ như nhau, tương tự khi cảm biến di chuyển sang trái đoạn 2d-26 thì chỉ có 1 led nằm trong đường line. Phải chọn giá trị của d sao cho các khoảng cách này là nhỏ nhất và thỏa điều kiện 𝑑 ≥ 8.68𝑚𝑚

- Xác định sự ảnh hưởng của đường line đến khoảng cách giữa 2 cảm biến

- Cách tiến hành thực nghiệm :

Cố định khoảng cách giữa cảm biến đến mặt sàn là h=6mm.Thay đổi khoảng cách giữa tâm cảm biến và tâm line từ tâm line ra đến vị trí cách tâm line 20mm theo 2 bước : + Dùng một cảm biến đơn di chuyển từ tâm ra vị trí cách tâm 20mm rồi vẽ lại đồ thị

quan hệ giữa khoảng cách và giá trị ADC

+ Cố định một cảm biến ở tâm line, sau đó dùng một cảm biến khác đặt sát cảm biến cố định. Di chuyển cảm biến thứ hai đó ra xa đến vị trí cách tâm line 20mm. Vẽ lại đồ thị quan hệ khoảng cách và giá trị ADC của cảm biến thứ hai. Từ đó ta có được đồ thị :

35

- Dựa vào đồ thị ta thấy rằng trong khoảng 14-18mm hai đường gần như trùng nhau. Điều này có nghĩa là trong khoảng 14-18mm, dù có hay không có cảm biến đặt kế bên thì giá trị ADC vẫn không đổi, chứng tỏ cảm biến không bị ảnh hưởng đến nhau. Ta chọn khoảng cách giữa hai cảm biến liên tiếp là 15 mm.

- Do sử dụng giải thuật xấp xỉ trọng số nên chọn ta đặt dãy cảm biến cách đều nhau.

Một phần của tài liệu BÁO cáo đồ án THIẾT kế hệ THỐNG cơ điện tử đề tài THIẾT kế, CHẾ tạo và điều KHIỂN ROBOT dò LINE (LINE FOLLOWING ROBOT ) (Trang 39 - 41)