Mơ tả Kích thước
Chiều dài chân 115 mm
Chiều dài cẳng chân 110 mm
Khớp xoay 40 mm
Thân 100 mm
3.2.Lựa chọn thiết bị
3.2.1. Bộ điều khiển board arduino mega 2560
Arduino Mega 2560 ( hình 3.4 ) là một vi điều khiển dựa trên nền ATmega 2560. C 54 đầu vào đầu ra số ( trong đ c 15 đầu được s dụng như đầu ra PWM ) 16 đầu vào analog 4 UARTs ( cổng nối tiếp phần cứng ) một 16 MHz dao động tinh thể kết nối USB một jack c m điện một đầu ICSP và một nút reset. Chứa tất cả mọi thứ cần thiết để h trợ các vi điều khiển ch cần kết nối với máy tính bằng cáp USB hoặc s dụng với một bộ chuyển đổi AC -to-DC hay pin. Arduino Mega tương thích với hầu hết các shield được thiết kế cho Arduino Duemilanove hoặc Diecimila.
Bảng 3.2 Tóm tắt thơng số Arduino Mega 2560
Microcontroller ATmega2560
Operating Voltage 5V
Input Voltage (recommended) 7-12V Input Voltage (limits) 6-20V
Digital I O Pins 54 (of which 15 provide PWM output)
Analog Input Pins 16
DC Current per I O Pin 40 mA DC Current for 3.3V Pin 50 mA
Flash Memory 256 KB of which 8 KB used by bootloader
SRAM 8 KB
EEPROM 4 KB
3.2.2. Shield Mega Sensor V2
Arduino Mega Sensor Shiled c cổng tương tác với người d ng thông qua giao tiếp với cổng COM và giao tiếp I2C c cổng giao tiếp SD card vì vậy c thể kết nối module một cách đơn giản tại mọi thời điểm. Shield Mega Sensor c nguồn cấp riêng biệt từ đ dễ dàng điều khiển các thiết bị như RC Servo cảm biến các thiết bị giao tiếp ngoại vi như Bluetooth Wifi…
Hình 3.4: Arduino Mega Sensor Shield
Hình 3.5: Sơ đồ chức năng các chân của Mega Sensor Shield
3.2.3.Động cơ RC Servo
C 3 loại động cơ thường được d ng để làm các mơ hình robot là động cơ DC Servo RC Servo và động cơ bước (Step motor). Đề tài sẽ s dụng động cơ RC Servo để điều khiển Robot vì động cơ RC Servo c phần hồi tiếp trạng thái bằng biến tr được tích hợp ngay bên trong động cơ việc điều khiển được đơn giản h a ch cần duy nhất một chân phát tín hiệu PWM và mơ hình này sẽ gần giống với việc s dụng những động cơ Servo
trong công nghiệp dễ dàng ứng dụng thuật toán được xây dựng trong đề tài để phát triển trong công nghiệp.
Tại sao không s dụng động cơ DC Servo và Step Motor? Hai loại động cơ này đều c một điểm khác biệt chung với động cơ RC Servo đ là vị trí Home. Với Động cơ RC Servo do s dụng biến tr cho nên vị trí Home sẽ được đặt tại một mức điện tr cố định. DC Servo và Step Motor sẽ lấy vị trị ngay lúc cấp nguồn là vị trí Home như vậy muốn kiểm soát được tọa độ của cánh tay robot ta phải s dụng thêm các cảm biến công t c hành trình … Như vậy sẽ phải s dụng nhiều hơn các chân vi điều khiển và cồng kềnh trong thiết kế.
DC Servo: phần hồi tiếp trạng thái thông dụng nhất là encoder nhưng với số lượng động cơ lớn đ i hỏi vi điều khiển phải mạnh và yêu cầu về tốc độ x l cao c ng như số lượng vector ng t lớn. Nếu khơng đáp ứng đủ thì dễ gây tình trạng treo vi điều khiển.
Step Motor: c momen yếu hơn DC Servo và RC Servo thiết kế to và cồng kềnh hay xảy ra tình trạng mất bước và khơng c phần hồi tiếp tích hợp nên sẽ gây ra sai số trong điều khiển.
Cho nên RC Servo là ph hợp nhất với các mơ hình robot di chuyển khơng bánh xe cấu tạo bên trong của động cơ RC Servo như hình 3.6:
Hình 3.6: Cấu tọa bên trong RC Servo
1. Motor (Động cơ)
2. Electronics Board (Board điện t )
3. Positive Power Wire (Red) (Dây nguồn màu đỏ)
4. Signal Wire (Yellow or White) (Dây tín hiệu thường là màu vàng hoặc màu tr ng) 5. Negative or Ground Wire (Black) (Dây GND đen)
6. Potentiometer (Biến tr )
7. Output Shaft Gear (Trục Bánh r ng đầu ra) 8. Servo Attachment Horn Wheel Arm
9. Servo Case (Vỏ Servo)
Trong hệ thống này Servo là đáp ứng của một dãy các xung số ổn định. Cụ thể hơn mạch điều khiển là đáp ứng của một tín hiệu số c các xung biến đổi từ 1ms – 2ms. Các xung này được g i đi 50 lần giây. Chú rằng không phải số xung trong một giây điều khiển servo mà là chiều dài của các xung. Servo đ i hỏi khoảng 30 – 60 xung giây. Nếu số này quá thấp độ chính xác và cơng suất để duy trì servo sẽ giảm. Với độ dài xung 1ms Servo được điều khiển quay theo một chiều (giả s là chiều kim đồng hồ). Với độ dài xung 2ms Servo quay theo chiều ngược lại.
Điều khiển vị trí của trục ra của động cơ bằng cách điều chế độ rộng xung (Hình 3.7)
Hình 3.7: Điều khiển vị trị trục ra của động cơ bằng cách điều chế độ rộng xung
Đề tài sẽ chọn động cơ RC Servo TowerPro MG946R để ph hợp với yêu cầu của cánh tay Robot. RC Servo TowerPro MG946R như hình 3.8:
Hình 3.8: RC Servo 946RBảng 3.3 Thơng số hoạt động của RC Servo TowerPro MG946R. Bảng 3.3 Thông số hoạt động của RC Servo TowerPro MG946R.
Weight (Trọng lượng) 55gram
Dimension (Kích thước) 40.7*19.7*42.9 mm
Operating speed (Tốc độ hoạt động) 0.20sec 60degree(4.8V) – 0.17s 60d(6V) Operating voltage (Điện áp hoạt động) 4.8V – 7.2V
Temperature range (Khoảng nhiệt độ) 0oC – 55oC
3.2.4. Module Bluetooth HC- 05
Mạch thu phát Bluetooth HC-05 đã ra chân hoàn ch nh giúp dễ dàng kết nối với các bộ điều khiển hoặc các module khác để truyền phát tín hiệu.
Hình 3.8:Module Bluetooth HC-05Bảng 3.5 Thông số kỹ thuật của Module Bluetooth HC-05 Bảng 3.5 Thông số kỹ thuật của Module Bluetooth HC-05
Điện áp hoạt động 3.3 – 5V
Baudrate 1200 2400 …115200
Dải tần s ng hoạt động 2.4Ghz
D ng điện 30mA khi kết nối 8mA khi truyền nhận
3.2.5. Khối cấp nguồn Adapter
Với một số thông cần thiết như sau:
Điện áp đầu vào: 100-240V 50 60Hz
Điện áp đầu ra: 5v-3a
\
Hình 3.9. Cấp nguồn Adapter
3.2.6. Camera Logitech C270
Bảng 3.6. Thông số kĩ thuật của Camera Logitech C270
Connection Type USB
USB Type USB 2.0
Microphone Built-in Noise Suppression Lens and Sensor Type Plastic
Focus Type Fixed
Field of View (FOV) 6
Focal Length 4.0 mm
Optical Resolution (True) 1280 x 960 1.2MP
Image Capture (4:3 SD) 320x240 640x480 1.2 MP 3.0 MP Image Capture (16:9 W) 360p 480p 720p
Video Capture (4:3 SD) 320x240 640x480 800x600 Video Capture (16:9 W) 360p 480p 720p
Frame Rate (max) 30fps @ 640x480
Video Effects (VFX) N A
Right Light Right Light 2
Buttons Other NA
Indicator Lights (LED) Activity Power
Privacy Shade No
Clip Size (max) 0 to infinity Cable Length 5 Feet or 1.5 Meters Ta s C270 để ph hợp về giá thành kích thước c ng như là tốc độ frame hình.
Hình 3.10 Camera Logitech C270
3.3.Sơ đồ nối dây
Các động rc được kết nối vào micro controller và được cấp nguồn từ adepter. Tổng cộng c 12 động cơ rc và 1 module bluetooth HC-05 kết nối với arduino.
Hình 3.10 Sơ đồ nối dây
3.4. Thuật toán điều khiển
3.4.1. Thuật toán điều khiển robot
Việc s dụng 12 động cơ RC Servo đ i hỏi phải chọn loại vi điều khiển phải đáp ứng đủ 12 ngõ ra b m xung PWM. Arduino Mega 2560 dựa trên nền tảng chip Atmega 2560 đã đáp ứng đủ cho việc điều khiển mơ hình.
Mơ hình điều khiển robot
Hình 3.11 Mơ hình điều khiển robot
Hình 3.12 Lưu đồ điều khiển robot
3.4.2. Huấn luyện model nhận dạng người
Nh m huấn luyện chọn model object detect MobileNet-SSD với bộ data về người gồm 100 tấm ảnh. Model được huấn luyện trong v ng 3 tiếng và được lưu trữ trên máy tính c core-i5 2.4GHz Ram 4GB. Cấu trúc của model MobileNet-SSD được trình bày chương 2. Do lượng data rất ít nên nh m nghiên cứu sẽ khơng tiến hành đánh giá q trình huấn luyện.
CHƯƠNG 4: THỰC NGHIỆM VÀ KẾT QUẢ
4.1.Kết quả điều khiển
Sau khi đã kiểm tra động học thuận nghịch ta tiến hành điều khiển robot qua module bluetooth bằng app điện thoại hình (hình 4.1). Robot hoạt động tốt c thể di chuyển theo 2 cách và đứng vững không cần tác động bên ngồi.
Hình 4.2 Hình ảnh robot lúc hoạt động
4.2.Kết quả nhận dạng người
Tuy c n hạn chế về data nhưng model sau khi đã train hoạt động khá tốt c thể nhận dạng được người trong môi trường xung từ đ làm tiền đề cho thuật toán tracking object sau này.
CHƯƠNG 5: KẾT LUẬN VÀ HƯỚNG PHÁT TRIỂN
5.1.Kết luận
5.1.1. Những công việc đã thực hiện
Sau một thời gian nghiên cứu và tìm hiểu nh m đã đã thực hiện :
Tìm hiểu tổng quan về mơ hình robot c chân n i chung và mơ hình robot bốn chân n i riêng.
Nghiên cứu và tính tốn độ ổn định cho robot bốn chân. Đây là cơ s quan trọng nhất cho việc điều khiển chuyển động cho robot.
Nghiên cứu các loại dáng đi của robot và đưa ra mơ hình hình học cho các loại dáng đi. Dựa vào động học thuận và nghịch tính tốn được vị trí đặt chân cho robot để c bước đi mượt và tránh bước nhảy.
Thiết kế thành cơng phần cơ khí Robot 4 chân.
Robot hoạt động đúng như mục tiêu mong muốn.
5.1.2. Những mặt hạn chế
Bên cạnh những nội dụng đã thực hiện được v n c n nhiều hạn chế đối với đề tài như:
Bài toán động học ch dừng lại động học vị trí chưa tính tốn bài tốn động học vận tốc. Bài toán động lực học s dụng các giả thiết để giảm bớt khối lượng tính tốn chưa hồn ch nh.
Việc nhận dạng chưa c chức n ng đối với mơ hình robot.
Mơ hình robot thực nghiệm ch đi được trên bề mặt bằng phẳng với quỹ đạo thẳng và chuyển hướng. Sai số về quỹ đạo chưa được kiểm sốt. Do khơng s dụng các cảm biến lực bàn chân nên khơng kiểm sốt được hiện tượng trượt gây ra sai số quỹ đạo.
Độ ổn định của mơ hình thực nghiệm chưa cao.
5.2.Hướng phát triển
Dựa trên những nghiên cứu thành công của đề tài “Thiết kế thi cơng và lập trình điều khiển Robot 4 chân” chúng ta c thể phát triển:
Chế tạo một mơ hình cơ khí với độ tin cậy cao.
Nghiên cứu các dáng di chuyển để robot c thể di chuyển trên các địa hình khơng bằng phẳng hoặc c vật cản.
Thiết kế cơ cấu robot để c thể tương tác với môi trường xung quanh.
Xây dựng bài tốn động học hồn ch nh cho robot.