Bối cảnh và vấn đề nghiên cứu

Trong bối cảnh cuộc Cách mạng công nghiệp lần thứ tư (Cách mạng công nghiệp 4.0), tự động hóa và công nghệ robot trở thành xu thế then chốt thúc đẩy năng suất lao động, đảm bảo độ chính xác cao trong sản xuất và hỗ trợ con người làm việc tại các môi trường khắc nghiệt, độc hại. Tại Việt Nam, nhu cầu làm chủ công nghệ tự động hóa, chế tạo và vận hành robot công nghiệp đang gia tăng mạnh mẽ, kéo theo yêu cầu cấp thiết về đào tạo nguồn nhân lực có trình độ kỹ thuật cao. Các hoạt động học tập, nghiên cứu và các cuộc thi công nghệ (như Sáng tạo Robot Việt Nam - Robocon, Robotics quốc tế) ngày càng được các trường đại học và doanh nghiệp chú trọng.

Xuất phát từ thực tiễn trên, tác giả Nguyễn Thái Phong đã thực hiện đề tài tốt nghiệp: "Nghiên cứu-xây dựng mô hình cánh tay robot 5 bậc tự do. Đi sâu nghiên cứu phần cứng" dưới sự hướng dẫn của TS. Nguyễn Trọng Thắng tại Trường Đại học Dân lập Hải Phòng (chuyên ngành Điện Tự Động Công Nghiệp, năm 2018).

Văn bản xác định các mục tiêu và nhiệm vụ nghiên cứu cụ thể như sau:

  1. Nghiên cứu tổng quan về cánh tay robot công nghiệp, tìm hiểu cấu tạo cơ khí và nguyên lý hoạt động của các hệ thống tay máy.
  2. Tìm hiểu cấu tạo, nguyên lý làm việc và phương thức ứng dụng của vi điều khiển Arduino trong việc điều khiển cánh tay robot.
  3. Vận dụng kiến thức chuyên ngành để thiết kế, gia công cơ khí và thi công mô hình phần cứng cánh tay robot 5 bậc tự do có khả năng vận hành và lập trình được.

Đối tượng và phạm vi nghiên cứu:

  • Đối tượng nghiên cứu: Mô hình cánh tay robot 5 bậc tự do điều khiển bằng vi điều khiển Arduino.
  • Phạm vi nghiên cứu: Tập trung vào cấu tạo cơ khí, nguyên lý hoạt động của cánh tay máy, phương pháp thiết lập bài toán động học và thi công phần cứng mạch điều khiển cho hệ thống robot 5 bậc tự do.

Cơ sở lý thuyết và phương pháp

Đồ án xây dựng dựa trên các nền tảng lý thuyết và phương pháp nghiên cứu kỹ thuật chuyên ngành:

  • Khung lý thuyết và mô hình toán học:

    • Lý thuyết robot học (Robotics) và cơ điện tử (Mechatronics).
    • Phương pháp ma trận tọa độ thuần nhất 4x4 (Homogeneous transformation matrix) dùng để mô tả vị trí và hướng của các khâu trong không gian 3 chiều.
    • Quy tắc Denavit-Hartenberg (bộ thông số D-H) để gắn hệ tọa độ cục bộ lên từng khâu khớp và thiết lập ma trận biến đổi thuần nhất giữa các khâu liên tiếp.
    • Lý thuyết động học thuận (Forward Kinematics) và động học ngược (Inverse Kinematics) của tay máy nhiều bậc tự do.
    • Lý thuyết điều khiển vòng hở (Open-loop system) và điều khiển vòng kín (Closed-loop servo system), phương pháp phát xung điều khiển động cơ servo.

  • Phương pháp nghiên cứu:

    • Phương pháp phân tích - tổng hợp tài liệu: Nghiên cứu lịch sử phát triển, các tiêu chuẩn định nghĩa quốc tế (AFNOR, VDI 2860, GOST-1980), các phương pháp phân loại và cấu trúc cơ bản của robot công nghiệp.
    • Phương pháp mô hình hóa hình học và toán học: Thiết lập bảng thông số D-H, tính toán ma trận chuyển đổi tọa độ và giải hệ phương trình động học tay máy.
    • Phương pháp thiết kế và thi công kỹ thuật: Lựa chọn kết cấu cơ khí, tính toán truyền động, lựa chọn chủng loại động cơ RC Servo và mạch vi điều khiển Arduino, đấu nối mạch phần cứng và lập trình điều khiển.

  • Nguồn dữ liệu: Tài liệu học thuật chuyên ngành tự động hóa, giáo trình robot công nghiệp, bảng thông số kỹ thuật linh kiện từ nhà sản xuất động cơ servo MG996R và tài liệu kỹ thuật vi điều khiển Arduino.

Thiết kế và triển khai

Hệ thống cánh tay robot 5 bậc tự do được thiết kế và thi công bao gồm ba khối chính:

[Khối Điều Khiển Trung Tâm (Arduino)] ---> [Khối Dẫn Động (Driver tích hợp trong Servo)] ---> [Cơ Cấu Cơ Khí (5 Bậc Tự Do + Tay Gắp)]

1. Cấu trúc phần cứng và linh kiện

  • Khối điều khiển trung tâm: Sử dụng bo mạch vi điều khiển Arduino để tính toán, tạo xung điều khiển độ rộng xung (PWM) và gửi tín hiệu đến các khớp động cơ.
  • Cơ cấu chấp hành (Động cơ RC Servo MG996R): Đồ án sử dụng động cơ Analog RC Servo MG996R (phiên bản nâng cấp từ dòng MG995) để dẫn động các trục khớp. Động cơ được trang bị bánh răng kim loại và vòng bi kép để tăng độ bền và giảm sai số cơ khí.
Thông số kỹ thuật Giá trị công bố trong văn bản
Chủng loại động cơ Analog RC Servo
Điện áp hoạt động 4.6 VDC – 6.0 VDC
Trọng lượng 55 g
Kích thước 40.9 mm
Lực kéo (Mô-men xoắn) 9.4 kgf·cm (tại 4.8V); 11.0 kgf·cm (tại 6.0V, khoảng 108 N·cm)
Dòng điện hoạt động 500 mA – 900 mA (tại 6V)
Dòng điện giữ mô-men (Stall current) 2.5 A (tại 6V)
Độ rộng vùng chết (Dead bandwidth) 5 µs
Nhiệt độ làm việc 0 ºC – 55 ºC
Cấu trúc cơ khí bên trong Bánh răng kim loại, thiết kế vòng bi đôi chống sốc

2. Kết cấu cơ khí và cơ chế hoạt động

  • Khung cánh tay máy, khớp nối và chân đế được gia công, lắp ghép tạo thành 5 bậc chuyển động độc lập tương ứng với các chuyển động định vị và định hướng, kết thúc bằng một khâu tác động cuối (tay gắp/kẹp chi tiết).
  • Mỗi khớp được dẫn động trực tiếp bởi một động cơ servo, cho phép quay các góc xác định theo tín hiệu phát xung điều khiển từ Arduino.

Nội dung chính theo từng chương

CHƯƠNG 1: TỔNG QUAN VỀ ROBOT

Chương 1 hệ thống hóa toàn diện các kiến thức tổng quan về ngành khoa học robot:

  • Lịch sử phát triển: Nguồn gốc thuật ngữ "robot" xuất hiện năm 1922 từ tác phẩm Rossum's Universal Robots của Karel Capek (tiếng Séc nghĩa là người làm tạp dịch). Sự ra đời của các tay máy chép hình cơ khí, thủy lực, điện từ sau Thế chiến 2 (như Minitaur I, Handyman của General Electric). Năm 1956, George Devol và Joseph F. Engelberger thành lập công ty Unimation, chế tạo robot công nghiệp đầu tiên năm 1959. Năm 1961, robot đầu tiên được đưa vào dây chuyền lắp ráp của General Motors tại Trenton, New Jersey (Hoa Kỳ). Năm 1967, Nhật Bản nhập khẩu robot đầu tiên từ AMF và phát triển vượt bậc vào năm 1990 với hơn 40 công ty sản xuất (tiêu biểu như Hitachi, Mitsubishi).
  • Các định nghĩa và tiêu chuẩn: Trình bày định nghĩa robot theo Viện nghiên cứu Mỹ, M.P. Groover, khối SEV, tiêu chuẩn AFNOR (Pháp), tiêu chuẩn VDI 2860 (Đức) và tiêu chuẩn GOST-1980 (Liên Xô cũ). Định nghĩa ngành khoa học liên ngành Robotics thuộc lĩnh vực Cơ điện tử (Mechatronics).
  • Phân loại robot:
    • Theo dạng hình học của không gian hoạt động: Robot tọa độ vuông góc (Rectilinear/Cartesian: 3 chuyển động tịnh tiến), robot tọa độ trụ (Cylindrical: 2 tịnh tiến, 1 quay), robot tọa độ cầu (Spherical: 1 tịnh tiến, 2 quay), robot khớp bản lề (Articulated: 3 trục quay) và robot SCARA (2 khớp quay, 1 khớp trượt song song).
    • Theo thế hệ: Thế hệ 1 (chu trình cố định, vòng hở, dùng cam/công tắc hành trình), thế hệ 2 (vòng kín, có cảm biến phản hồi thích ứng), thế hệ 3 (xử lý phản xạ logic, nhận dạng hình ảnh mức thấp), thế hệ 4 (điều khiển thích nghi theo mô hình, tự lập trình lại), thế hệ 5 (trí tuệ nhân tạo, mạng nơ-ron tự học, logic mờ).
    • Theo nguồn dẫn động: Dẫn động điện (DC, AC - thiết kế gọn, chạy êm, định vị chính xác), dẫn động khí nén (áp dụng cho lắp đặt không cần độ chính xác cao), dẫn động thủy lực (lực nâng lớn, tải trọng nặng) và dẫn động hỗn hợp.
    • Bảng phân loại tổng hợp của tác giả: Phân chia theo số bậc chuyển động, số lượng tay máy, tải trọng nâng (siêu nhẹ, nhẹ, chung, nặng, siêu nặng), hệ thống điều khiển, số robot được điều khiển, cấp độ chính xác (cấp 0, 1, 2, 3) và kiểu bảo vệ môi trường (thông thường, phòng bụi, phòng nhiệt, phòng nổ).
  • Cấu tạo chung robot công nghiệp: Phân tích 3 thành phần cơ bản gồm Tay máy (khâu, khớp, cánh tay, cổ tay với 3 bậc tự do Roll-Pitch-Yaw, khâu công tác), Nguồn cung cấp và Bộ điều khiển (CPU 8/16-bit hoặc PC-based, bộ nhớ, khối xuất nhập, teach pendant). Phân biệt điều khiển vòng hở và điều khiển vòng kín (điều khiển điểm - điểm PTP và điều khiển theo đường liên tục Contour).

CHƯƠNG 2: XÂY DỰNG BÀI TOÁN ĐỘNG HỌC TAY MÁY

Chương 2 tập trung giải quyết cơ sở toán học cho chuyển động của tay máy:

  • Khái niệm và định nghĩa: Thiết lập hệ tọa độ tham chiếu, hệ tọa độ tuyệt đối, tương đối và vector tọa độ suy rộng $q = (q_1, q_2, \dots, q_n)^T$ tương ứng với các chuyển vị góc hoặc chuyển vị dài tại các khớp.
  • Phát biểu bài toán động học:
    • Bài toán động học thuận: Cho trước quy luật biến khớp $q_i(t)$, xác định vị trí và hướng của khâu tác động cuối trong hệ tọa độ Đề-các.
    • Bài toán động học ngược: Cho trước vị trí và hướng của khâu tác động cuối trong hệ tọa độ Đề-các, xác định quy luật các biến khớp $q_i(t)$ tương ứng.
  • Phương pháp ma trận tọa độ thuần nhất: Biểu diễn điểm trong không gian $n$ chiều bằng vector mở rộng $n+1$ chiều $r = (\omega r_x, \omega r_y, \omega r_z, \omega)^T$ với hệ số tỉ lệ $\omega = 1$. Ma trận biến đổi thuần nhất $4 \times 4$ tổng quát có dạng:

$$T = \begin{bmatrix} R_{3 \times 3} & p_{3 \times 1} \ 0_{1 \times 3} & 1_{1 \times 1} \end{bmatrix} = \begin{bmatrix} n_x & s_x & a_x & p_x \ n_y & s_y & a_y & p_y \ n_z & s_z & a_z & p_z \ 0 & 0 & 0 & 1 \end{bmatrix}$$

Trong đó $R$ là ma trận quay $3 \times 3$, $p$ là vector tịnh tiến $3 \times 1$, các vector $n, s, a$ lần lượt là các vector chỉ phương của hệ tọa độ gắn trên khâu. Xây dựng các ma trận biến đổi tịnh tiến $T_p$, ma trận quay quanh các trục tọa độ cơ bản $R(x, \alpha), R(y, \beta), R(z, \phi)$, ma trận quay quanh trục bất kỳ $R(r, \phi)$ và phép quay theo 3 góc Euler.

  • Thuật toán Denavit-Hartenberg (D-H): Xây dựng hệ tọa độ và xác định 4 thông số hình học giữa hai khâu liên tiếp $i$ và $i+1$:

    • $a_i$: Độ dài đường vuông góc chung giữa hai trục khớp động $i$ và $i+1$.
    • $\alpha_i$: Góc chéo giữa hai trục khớp động $i$ và $i+1$.
    • $d_i$: Khoảng cách dọc trục khớp động $i$ giữa hai đường vuông góc chung.
    • $\theta_i$: Góc quay giữa hai đường vuông góc chung quanh trục khớp $i$.

    Ma trận biến đổi cục bộ $A_i$ giữa hai khâu liên tiếp:

$$A_i = \begin{bmatrix} \cos\theta_i & -\sin\theta_i\cos\alpha_i & \sin\theta_i\sin\alpha_i & a_i\cos\theta_i \ \sin\theta_i & \cos\theta_i\cos\alpha_i & -\cos\theta_i\sin\alpha_i & a_i\sin\theta_i \ 0 & \sin\alpha_i & \cos\alpha_i & d_i \ 0 & 0 & 0 & 1 \end{bmatrix}$$

  • Trình tự giải bài toán động học:
    • Động học thuận: Thiết lập bảng thông số D-H $\to$ Tính các ma trận $A_i \to$ Tính ma trận tổng quát $T_n = A_1 A_2 \dots A_n \to$ Đạo hàm bậc 1, bậc 2 để xác định vận tốc, gia tốc khâu công tác.
    • Động học ngược: Xuất phát từ phương trình $T_n = A_1 A_2 \dots A_n$, nhân nghịch đảo từng ma trận sang vế trái ($A_i^{-1} \dots A_1^{-1} T_n = A_{i+1} \dots A_n$) để so sánh các phần tử tương ứng ở hai vế ma trận, tạo ra 6 phương trình độc lập giải ra các biến khớp $q_i$.

CHƯƠNG 3: THIẾT KẾ VÀ THI CÔNG MÔ HÌNH ROBOT 5 BẬC TỰ DO

Chương 3 trình bày việc chế tạo thực tế mô hình phần cứng:

  • Lựa chọn thiết bị: Sử dụng hệ thống động cơ servo RC MG996R chịu tải lớn, điện áp 4.6V - 6V, lực kéo cực đại 11 kgf·cm tại 6V, nhông kim loại và tích hợp driver phát xung góc quay.
  • Mạch điều khiển: Sử dụng bo mạch Arduino làm trung tâm xử lý, giao tiếp và phát tín hiệu xung điều khiển các góc quay servo.
  • Gia công và thi công phần cứng: Lắp ráp khung cơ khí cánh tay robot, các khớp nối bản lề và chân đế vững chắc, đảm bảo phạm vi hoạt động của 5 bậc tự do và khâu công tác tay gắp.
  • Quy trình hoạt động và phần mềm: Xây dựng quy trình hoạt động tuần tự và nạp mã nguồn điều khiển các trục khớp qua phần mềm lập trình Arduino.

Kết quả và đóng góp

Kết quả chính

  • Tổng hợp hệ thống lý thuyết về cấu tạo, phân loại, các tiêu chuẩn và nguyên lý điều khiển robot công nghiệp.
  • Xây dựng phương pháp toán học thiết lập phương trình động học thuận và động học ngược dựa trên ma trận tọa độ thuần nhất $4 \times 4$ và phương pháp thông số Denavit-Hartenberg (D-H).
  • Thiết kế, lựa chọn linh kiện và thi công hoàn thiện mô hình phần cứng cánh tay robot 5 bậc tự do sử dụng động cơ servo kim loại MG996R (lực kéo 9.4 - 11.0 kgf·cm, dòng giữ 2.5A) và bo mạch điều khiển Arduino.
  • Kết nối thành công mạch phần cứng, nạp chương trình điều khiển và vận hành thử nghiệm chuyển động của các trục khớp trên mô hình thực tế.

Giải pháp và ứng dụng đề xuất

  • Mô hình cánh tay robot được đề xuất ứng dụng trong các bài toán tự động hóa sản xuất: gắp và phân loại sản phẩm theo màu sắc hoặc hình dáng, gắp chia sản phẩm từ băng chuyền vào khay/thùng chứa, ứng dụng trong các nguyên công hàn, cắt hoặc nâng hạ vật thể.
  • Đề xuất sử dụng mô hình làm thiết bị thí nghiệm, thực hành trực quan phục vụ công tác giảng dạy chuyên ngành Điện Tự Động Công Nghiệp.

Đóng góp của đề tài

  • Hiện thực hóa lý thuyết động học tay máy thành mô hình vật lý cụ thể với chi phí hợp lý.
  • Làm chủ quy trình thiết kế phần cứng, tích hợp vi điều khiển Arduino với các cơ cấu chấp hành servo RC công suất nhỏ phục vụ nghiên cứu và học tập.

Hạn chế và hướng nghiên cứu tiếp

Dựa trên phạm vi và nội dung văn bản:

  • Hạn chế: Đề tài tập trung chủ yếu vào phần cứng cơ bản và lý thuyết động học; mô hình vận hành theo chu trình góc đặt sẵn, chưa tích hợp hệ thống cảm biến nhận biết môi trường bên ngoài (như cảm biến lực, cảm biến thị giác/camera để tự động nhận dạng đối tượng).
  • Hướng nghiên cứu tiếp:
    • Tích hợp thêm các cảm biến ngoại tín hiệu (cảm biến màu sắc, cảm biến thị giác máy tính) để hoàn thiện bài toán gắp và phân loại sản phẩm tự động.
    • Mở rộng thuật toán điều khiển thích nghi và điều khiển quỹ đạo chuyển động liên tục cho tay máy.
    • Kết nối mô hình cánh tay robot đồng bộ với hệ thống băng chuyền công nghiệp thực tế.

Giá trị tham khảo

Tài liệu khóa luận có giá trị tham khảo thiết thực cho:

  • Sinh viên và giảng viên: Chuyên ngành Điện Tự Động Công Nghiệp, Cơ điện tử, Kỹ thuật Điều khiển và Tự động hóa cần tài liệu tham khảo về bài toán động học tay máy và thiết kế mô hình robot học tập.
  • Người nghiên cứu và phát triển mô hình: Các kỹ sư, sinh viên làm đề tài nghiên cứu hoặc tham gia các cuộc thi sáng tạo robot (Robocon) cần tra cứu thông số kỹ thuật động cơ servo RC MG996R, quy tắc đặt hệ trục tọa độ D-H và kỹ thuật kết nối vi điều khiển Arduino với cơ cấu chấp hành nhiều bậc tự do.

Câu hỏi thường gặp

1. Đề tài lựa chọn xây dựng mô hình cánh tay robot có bao nhiêu bậc tự do và sử dụng vi điều khiển nào?

Đề tài nghiên cứu và thi công mô hình cánh tay robot có 5 bậc tự do, sử dụng bo mạch vi điều khiển Arduino để xử lý tín hiệu và điều khiển hoạt động của các khớp.

2. Động cơ servo MG996R sử dụng trong mô hình có những thông số kỹ thuật chính nào?

Động cơ MG996R là loại Analog RC Servo có bánh răng kim loại và vòng bi đôi; điện áp hoạt động từ 4.6V đến 6.0V; trọng lượng 55g; kích thước 40.9 mm; lực kéo đạt 9.4 kgf·cm tại 4.8V và 11.0 kgf·cm tại 6.0V (khoảng 108 N·cm); dòng làm việc 500 - 900 mA (6V) và dòng giữ mô-men tối đa 2.5 A (6V); độ rộng vùng chết 5 µs.

3. Phương pháp toán học nào được tác giả sử dụng để mô tả và giải bài toán động học cho cánh tay robot?

Tác giả sử dụng phương pháp ma trận tọa độ thuần nhất $4 \times 4$ kết hợp với bộ 4 thông số Denavit-Hartenberg ($a_i, \alpha_i, d_i, \theta_i$) để gắn hệ tọa độ lên từng khâu, xây dựng ma trận chuyển đổi $A_i$ và thiết lập hệ phương trình động học thuận - ngược cho tay máy.

4. Bốn tham số trong bộ thông số Denavit-Hartenberg (D-H) được định nghĩa như thế nào trong đồ án?

Bốn thông số D-H gồm: (1) $a_i$ là độ dài đường vuông góc chung giữa hai trục khớp động $i$ và $i+1$; (2) $\alpha_i$ là góc chéo giữa hai trục khớp $i$ và $i+1$; (3) $d_i$ là khoảng cách dọc trục khớp động $i$ giữa hai đường vuông góc chung; (4) $\theta_i$ là góc giữa hai đường vuông góc chung quanh trục khớp $i$.

5. Cánh tay robot 5 bậc tự do trong đề tài được định hướng ứng dụng vào những công việc thực tế nào?

Theo tác giả, kết quả nghiên cứu của mô hình có thể ứng dụng để xây dựng hệ thống tự động gắp và phân loại sản phẩm theo màu sắc/hình dáng, chia sản phẩm từ băng chuyền vào khay/thùng, ứng dụng trong thao tác hàn, cắt, nâng hạ vật thể và làm thiết bị thực hành trực quan cho sinh viên ngành Điện tự động công nghiệp.

Kết luận

Đồ án tốt nghiệp của sinh viên Nguyễn Thái Phong đã giải quyết trọn vẹn nhiệm vụ nghiên cứu lý thuyết tổng quan về robot công nghiệp và cơ sở toán học động học tay máy nhiều bậc tự do. Tác giả đã ứng dụng thành công phương pháp ma trận tọa độ thuần nhất và quy tắc Denavit-Hartenberg để mô hình hóa chuyển động của cánh tay robot. Đồng thời, đề tài đã thi công hoàn thiện mô hình phần cứng cánh tay robot 5 bậc tự do sử dụng động cơ servo MG996R điều khiển qua bo mạch Arduino, đáp ứng tốt yêu cầu thực nghiệm và tạo tiền đề phục vụ công tác đào tạo thực hành chuyên ngành Tự động hóa.