Cảm biến xmin xmax Phương trình calib
x0 52 726 y0= 550+0.5935(x0-52) x1 309 636 y1= 550+1.22(x1-309) x2 64 812 y2= 550+0.53476(x2-64) x3 56 620 y3= 550+0.70922.(x3-56) x4 57 450 y4= 550+1,01781(x4-57) x5 57 576 y5= 550+0,77071.(x5-57) x6 59 713 y6= 550+0,61162(x6-59) Chọn ymin=550, ymax= 950
ĐỒ ÁN THIẾT KẾ HỆ THỐNG CƠ ĐIỆN TỬ GVHD: TS. Phùng Trí Cơng. Tìm vị trí của tâm đường line dựa vào giải thuật xắp xỉ:
Phương pháp thực hiện: Dùng 7 cảm biến, bố trí thành hàng ngang. Ghi lại các giá trị đọc được từ các cảm biến. Dùng phương pháp trung bình của tài liệu để tính vị trí của tâm các cảm biến so với đường line. Từ đó tính ra sai số.
Cách bố trí:
- Chiều cao test của cảm biến là 10 mm.
- Theo tài liệu [ ], ta chọn khoảng cách giữa các con cảm biến sao cho khi di chuyển cảm biến từ tâm đường line ra tại vị trí mà cảm biến đọc về cịn lại 50% giá trị của nó. Từ thực nghiệm, ta chọn khoảng cách 2 con là 12.5 mm.
- Số lượng cảm biến:7
Hình 4.11 Sơ đồ bố trí cảm biến
Theo [ ], các cảm biến x0, x1, x2, x3, x4, x5, x6 tương ứng với các tọa độ -3, -2, -1, 0, 1, 2, 3, giá trị trả về của các cảm biến tương ứng là y0, y1, y2, y3, y4, y5, y6 như hình vẽ sau:
ĐỒ ÁN THIẾT KẾ HỆ THỐNG CƠ ĐIỆN TỬ GVHD: TS. Phùng Trí Cơng. Cơng thức tính giá trị trung bình:
7 i i i 0 6 0 5 1 4 2 7 7 i i i 0 i 0 x y 3(y y ) 2(y y ) (y y ) x y y Tóm lại : + Số lượng cảm biến 7
+ Chiều cao cảm biến so với nền 10 mm + Khoảng cách giữa hai cảm biến 12.5 mm
+ Kiểu sắp xếp cảm biến : loại một hàng đơn, đặt ngang.
4.3 Lựa chọn driver:
Yêu cầu:
Driver kết hợp với động cơ phải có đặc tính tuyến tính giữa áp đầu vào driver và vận tốc đầu ra của động cơ.
Driver phải có khả năng cung cấp 12V DC và dịng 600mA cho động cơ đã tính tốn ở phần cơ khí.
Đáp ứng được tần số xung PWM từ vi điều khiển. Kích thước nhỏ gọn, phù hợp lắp trên xe .
Ta chọn driver điều khiển động cơ L298N có thơng số cơ bản: +Driver: L298N tích hợp hai mạch cầu H.
+Điện áp điều khiển: +5 V ~ +12 V +Dòng tối đa cho mỗi cầu H là: 2A
+Điện áp của tín hiệu điều khiển: +5 V ~ +7 V +Dịng của tín hiệu điều khiển: 0 ~ 36mA
4.3.1 Mơ hình hóa hệ driver-động cơ
Để đơn giản cho việc điều khiển, động cơ và driver đƣợc xem như là một khối. Tiến hành kiểm tra mối quan hệ giữa tín hiệu vào và ra của khối này bằng việc cấp xung PWM và ghi lại giá trị vận tốc động cơ.
Phương pháp tiến hành: Sử dụng arduino Uno có chế độ hiển thị monitor, kết hợp
ĐỒ ÁN THIẾT KẾ HỆ THỐNG CƠ ĐIỆN TỬ GVHD: TS. Phùng Trí Cơng. xung/vòng bằng PWM. Động cơ được cấp nguồn 12V, thay đổi % giá trị duty cycle từ 20 đến 100, quan sát chế độ hiển thị monitor, ghi lại giá trị vận tốc động cơ tương ứng.
Kết quả thể hiện trong hình bên dưới: