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

Đồ án 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" được thực hiện bởi sinh viên Nguyễn Thái Phong (Lớp ĐC1801, Ngành Điện Tự Động Công Nghiệp, Trường Đại học Dân lập Hải Phòng, năm 2018) dưới sự hướng dẫn của TS. Nguyễn Trọng Thắng.

Lý do chọn đề tài xuất phát từ bối cảnh cuộc Cách mạng công nghiệp 4.0 đang diễn ra mạnh mẽ trên quy mô toàn cầu, mang lại cơ hội chuyển đổi phương thức sản xuất cho các nền kinh tế, trong đó có Việt Nam. Tự động hóa và công nghệ robot là xu hướng tất yếu của nền sản xuất công nghiệp tương lai nhờ khả năng nâng cao năng suất, đảm bảo độ chính xác và thay thế con người làm việc an toàn trong các môi trường độc hại, khắc nghiệt như công xưởng, vũ trụ, đáy biển hoặc hệ thống đường ống chất thải. Tại Việt Nam, nhu cầu làm chủ công nghệ tự động hóa ngày càng cấp thiết, thể hiện qua phong trào nghiên cứu, chế tạo robot phục vụ các cuộc thi công nghệ (Robocon trong nước và quốc tế) cũng như nhu cầu đào tạo nguồn nhân lực chất lượng cao phục vụ các dây chuyền công nghiệp hiện đại.

Mục tiêu nghiên cứu của đồ án được xác định gồm ba nội dung chính:

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

Nhiệm vụ nghiên cứu bao gồm việc tính toán cơ sở lý thuyết động học tay máy, thu thập số liệu thiết kế cơ khí, lựa chọn thiết bị phần cứng, xây dựng mạch điều khiển và lập trình chuyển động cho hệ thống cơ cấu chấp hành.

Đối tượng nghiên cứu là mô hình cánh tay robot 5 bậc tự do sử dụng mạch vi điều khiển Arduino. Phạm vi nghiên cứu tập trung vào cấu trúc phần cứng cơ khí, cơ cấu chấp hành sử dụng động cơ RC Servo, giải thuật động học và lập trình điều khiển chuyển động trong không gian thao tác của mô hình.

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

Khung lý thuyết của đồ án dựa trên lý thuyết điều khiển tay máy và động học robot nhiều khâu khớp:

  • Khái niệm và định nghĩa robot: Đề tài tổng hợp hệ thống khái niệm theo nhiều chuẩn quốc tế và trường phái khoa học, bao gồm định nghĩa của Viện nghiên cứu Mỹ, tiêu chuẩn AFNOR (Pháp), VDI 2860/BRD (CHLB Đức), GOST-1980 (Liên Xô cũ) cùng các định nghĩa của M.P. Groover.
  • Biểu diễn không gian và tọa độ thuần nhất: Sử dụng phương pháp tọa độ thuần nhất để mô tả mối quan hệ vị trí và hướng giữa các khâu. Không gian $n$ chiều được chuyển vị sang không gian $n+1$ chiều thông qua việc bổ sung thành phần thứ tư với hệ số tỉ lệ ngầm định $\omega = 1$. Ma trận biến đổi thuần nhất $4 \times 4$ gồm ma trận quay $3 \times 3$, vector tịnh tiến $3 \times 1$, ma trận phối cảnh $1 \times 3$ và hệ số tỉ lệ $1 \times 1$.
  • Bộ thông số Denavit - Hartenberg (D-H): Sử dụng phương pháp mô hình hóa động học cơ bản dựa trên 4 thông số đặc trưng giữa hai trục khớp liên tiếp: độ dài đường vuông góc chung ($a_i$), góc chéo giữa hai trục khớp ($\alpha_i$), khoảng cách dọc trục khớp ($d_i$) và góc quay giữa hai đường vuông góc chung ($\theta_i$).

Phương pháp nghiên cứu thực tế gồm bốn nhánh triển khai:

  1. Nghiên cứu tổng quan lý luận và cơ sở khoa học về phân loại, cấu trúc động học, nguồn dẫn động và hệ thống điều khiển robot.
  2. Thiết lập và giải bài toán động học thuận và động học ngược của tay máy bằng phương pháp tọa độ thuần nhất kết hợp đại số ma trận.
  3. Nghiên cứu gia công cơ khí, lựa chọn kết cấu khung cánh tay, khớp nối và bàn tay kẹp (end-effector).
  4. Nghiên cứu ứng dụng mạch vi điều khiển Arduino và mạch phân phối xung điều khiển động cơ servo.

Nguồn dữ liệu kỹ thuật sử dụng trong đồ án bao gồm các tài liệu chuyên ngành về Robotics, các tiêu chuẩn chế tạo máy công nghiệp và bảng thông số kỹ thuật (datasheet) của dòng động cơ Analog RC Servo MG996R.

Thiết kế và thi công hệ thống phần cứng

Do đồ án thuộc hệ thống kỹ thuật phần cứng, nội dung thiết kế và chế tạo thực nghiệm được tác giả triển khai tập trung vào việc lựa chọn linh kiện, cơ cấu chấp hành và bố trí kết cấu cơ khí cho cánh tay máy 5 bậc tự do.

Hệ thống cơ cấu chấp hành sử dụng đồng bộ động cơ RC Servo MG996R (phiên bản cải tiến từ dòng MG995), tích hợp sẵn mạch điều khiển theo cơ chế phát xung - quay góc (PWM). Động cơ được chế tạo với hệ bánh răng kim loại chịu lực, vòng bi đôi (twin ball bearing) chống rung lắc, cung cấp phản ứng tốc độ nhanh và mô-men xoan kéo lớn, phù hợp cho các khớp cử động của robot.

Bảng tổng hợp thông số kỹ thuật của động cơ RC Servo MG996R được sử dụng trong mô hình:

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 làm việc 4,6 VDC
Kích thước thân 40,9 mm
Trọng lượng 55 g
Lực kéo (mô-men xoắn) 9,4 kgf·cm (tại 4,8V); 11 kgf·cm (tại 6,0V - tương đương ~108 N·cm)
Tốc độ quay không tải 0,17 s/60° (tại 4,8V); 0,14 s/60° (tại 6,0V)
Dòng điện hoạt động 500 mA - 900 mA (tại 6,0V)
Dòng điện giữ mô-men (Stall) 2,5 A (tại 6,0V)
Độ rộng dải chết (Dead band) 5 µs
Nhiệt độ làm việc 0 °C - 55 °C
Cấu tạo cơ khí bên trong Toàn bộ bánh răng bằng kim loại, thiết kế vòng bi đôi

Về phần điều khiển, hệ thống ứng dụng bo mạch Arduino làm bộ xử lý trung tâm, chịu trách nhiệm nhận lệnh, tính toán góc quay cho từng trục và phát tín hiệu PWM độc lập đến các kênh driver điều khiển servo. Kết cấu cơ khí gồm cụm đế quay, khớp vai, khớp khuỷu, cụm cổ tay và cơ cấu kẹp cuối (gripper), đảm bảo khả năng định vị 3 bậc tự do và định hướng không gian cho khâu thao tác.

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

Chương 1: Tổng quan về robot

Chương này trình bày toàn diện lịch sử phát triển, định nghĩa, phân loại và kết cấu cơ bản của robot công nghiệp:

  • Lịch sử phát triển: Nguồn gốc thuật ngữ "robot" xuất hiện từ tác phẩm "Rossum's Universal Robots" (R.U.R.) của Karel Capek năm 1922. Sự xuất hiện của các tay máy chép hình cơ khí sau Chiến tranh thế giới thứ hai tại Mỹ; tay máy thủy lực Minitaur I và Handyman của General Electric cuối thập niên 1950. George Devol và Joseph F. Engelberger sáng lập Unimation (1956), đưa robot Unimate đầu tiên vào vận hành tại nhà máy General Motors (Trenton, New Jersey) năm 1961. Thập niên 1970 - 1990 đánh dấu sự gia nhập của Nhật Bản (Hitachi, Mitsubishi) và các bước tiến về tích hợp cảm biến lực, cảm biến thị giác tại Đại học Stanford, Ford và IBM.
  • Định nghĩa và đặc trưng: Robot công nghiệp thỏa mãn 5 tiêu chí cơ bản: khả năng thay đổi chuyển động, khả năng cảm nhận đối tượng thao tác, số bậc chuyển động cao, khả năng thích nghi môi trường và tính tương hỗ với đối tượng bên ngoài.
  • Hệ thống phân loại:
    • Theo không gian hoạt động: Robot tọa độ vuông góc (Cartesian), tọa độ trụ (Cylindrical), tọa độ cầu (Spherical), khớp bản lề (Articulated) và robot SCARA (chuyên dùng cho lắp ráp linh kiện với độ cứng vững theo trục đứng).
    • Theo thế hệ: Thế hệ 1 (điều khiển vòng hở, dùng cam và công tắc hành trình); Thế hệ 2 (vòng kín, phản hồi từ cảm biến vị trí); Thế hệ 3 (xử lý logic thích nghi, tích hợp hình ảnh cơ bản); Thế hệ 4 (điều khiển thích nghi theo mô hình tính toán); Thế hệ 5 (trí tuệ nhân tạo, mạng nơ-ron và logic mờ).
    • Theo nguồn dẫn động: Dẫn động thủy lực (lực lớn, chạy êm nhưng giá thành cao, cồng kềnh); dẫn động khí nén (giá rẻ, sạch nhưng khó kiểm soát chính xác vị trí); dẫn động điện cơ (động cơ bước, động cơ DC, động cơ AC với ưu điểm phản ứng nhanh, điều khiển linh hoạt).
  • Cấu tạo chung: Gồm 3 thành phần chính: Cơ cấu tay máy (khâu, khớp, cánh tay, cổ tay 3 bậc Roll - Pitch - Yaw, cơ cấu công tác), Nguồn cung cấp (điện, khí nén, thủy lực) và Bộ điều khiển (CPU, bộ nhớ, bộ xuất nhập, bảng lập trình cầm tay teach-pendant). So sánh hệ thống điều khiển vòng hở (open-loop, non-servo) và điều khiển vòng kín (closed-loop, servo theo điểm - điểm hoặc bám quỹ đạo liên tục).

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 mô hình toán học giải tích cho chuyển động của tay máy:

  • Khái niệm bài toán động học:
    • Bài toán động học thuận: Cho trước quy luật biến thiên của các biến khớp suy rộng $q_i(t)$ (chuyển vị góc của khớp quay hoặc chuyển vị dài của khớp trượt), xác định vị trí và hướng của khâu tác động cuối trong hệ tọa độ Descartes tuyệt đối.
    • Bài toán động học ngược: Cho trước tọa độ vị trí và góc hướng mong muốn của khâu chấp hành cuối trong hệ tọa độ Descartes, tính toán các biến khớp suy rộng $q_i$ tương ứng để các khâu thành viên dịch chuyển đạt cấu hình yêu cầu.
  • Phương pháp tọa độ thuần nhất: Biểu diễn điểm $M$ qua vector mở rộng $r = (r_x, r_y, r_z, 1)^T$. Thiết lập ma trận biến đổi thuần nhất tổng quát $T_{ij}$:

$$T_{ij} = \begin{bmatrix} R_{3\times3} & P_{3\times1} \ 0_{1\times3} & 1 \end{bmatrix}$$

Trình bày các ma trận quay cơ bản quanh các trục $Ox, Oy, Oz$, phép biến đổi tịnh tiến, phép quay quanh một trục bất kỳ trong không gian và phép quay biểu diễn qua ba góc Euler.

  • Bộ thông số và thuật toán Denavit - Hartenberg (D-H): Trình bày nguyên tắc gắn hệ tọa độ lên từng khâu khớp: trục $z_i$ dọc theo trục chuyển động của khớp thứ $i+1$, trục $x_i$ nằm dọc theo đường vuông góc chung hướng từ khớp $i$ sang khớp $i+1$. Ma trận chuyển đổi thuần nhất $A_i$ giữa hai khâu liên tiếp được xác định theo công thức:

$$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}$$

  • Phương pháp giải bài toán động học: Thiết lập phương trình động học thuận tổng quát $T_n = A_1 A_2 \dots A_n$. Thiết lập thuật toán giải bài toán động học ngược bằng cách nhân liên tiếp các ma trận nghịch đảo $A_i^{-1}$ sang vế trái để phân tách và giải hệ 6 phương trình độc lập tìm nghiệm của từng 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 này mô tả quá trình hiện thực hóa mô hình vật lý:

  • Khảo sát và lựa chọn thiết bị: Lựa chọn động cơ Analog RC Servo MG996R nhờ mô-men giữ lớn (lên tới 11 kgf·cm tại nguồn 6V) và bánh răng kim loại bền vững, kết hợp mạch vi điều khiển Arduino.
  • Bố trí kết cấu phần cứng: Gia công và lắp ráp cơ cấu cơ khí cho các khâu cánh tay, gối đỡ, khớp bản lề quay và chân đế chịu lực; thiết kế tay kẹp cơ khí sử dụng động cơ servo riêng biệt.
  • Xây dựng mạch giao tiếp phần cứng: Đấu nối nguồn cấp dòng cao riêng biệt cho dàn động cơ servo để tránh hiện tượng sụt áp vi điều khiển khi cơ cấu chịu tải, phân bổ các kênh băm xung PWM từ Arduino.
  • Quy trình hoạt động: Thiết lập các trạng thái chuyển động tuần tự của cánh tay robot từ vị trí nghỉ (Home position), hạ tầm với, kẹp giữ vật thể, nâng và di chuyển theo góc quay xác định, thả vật phẩm và quay về vị trí ban đầu.

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

Về kết quả kỹ thuật:

  • Hoàn thiện mô hình cánh tay robot 5 bậc tự do thực tế, sử dụng động cơ RC Servo MG996R (lực kéo 9,4 - 11 kgf·cm, bánh răng kim loại) và mạch vi điều khiển Arduino.
  • Hệ thống hóa đầy đủ cơ sở toán học động học tay máy, xây dựng thuật toán biến đổi tọa độ thuần nhất 4x4 và bảng thông số D-H phục vụ tính toán chuyển động.
  • Mô hình đáp ứng được các chuyển động độc lập tại từng khớp, thực hiện được chu trình kẹp, nâng, di chuyển và thả vật thể theo kịch bản định trước.

Giải pháp và kiến nghị ứng dụng:

  • Đề xuất khả năng ứng dụng mô hình vào dây chuyền phân loại sản phẩm tự động (gắp sản phẩm theo màu sắc, kích thước hoặc chuyển sản phẩm từ băng tải sang thùng chứa).
  • Đề xuất mở rộng cánh tay máy vào các ứng dụng hàn điểm, cắt hoặc nâng chuyển phôi trong các phân xưởng cơ khí quy mô vừa và nhỏ.

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

  • Cung cấp một mô hình thực nghiệm trực quan, có chi phí chế tạo hợp lý, đóng vai trò làm học cụ phục vụ đào tạo, thực hành thí nghiệm cho sinh viên chuyên ngành Điện Tự Động Công Nghiệp tại Trường Đại học Dân lập Hải Phòng.

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

Hạn chế của đề tài:

  • Đề tài tập trung chủ yếu vào việc chế tạo phần cứng và điều khiển vòng hở cơ bản thông qua phát xung trực tiếp cho các động cơ servo analog; chưa trang bị hệ thống cảm biến ngoại tín hiệu (cảm biến lực kẹp, cảm biến hành trình quang hoặc cảm biến tiệm cận).
  • Việc giải bài toán động học ngược mới dừng lại ở mức độ thiết lập phương pháp lý thuyết tổng quát, chưa xây dựng giao diện điều khiển thời gian thực trên máy tính để bám quỹ đạo phức tạp.

Hướng phát triển tiếp theo được tác giả định hướng:

  • Tích hợp thêm module xử lý ảnh (Camera) và cảm biến màu sắc để cánh tay robot có khả năng tự động nhận dạng, phân loại các sản phẩm khác nhau trên băng chuyền.
  • Nâng cấp thuật toán điều khiển quỹ đạo liên tục, kết hợp phản hồi lực kẹp ở đầu khâu tác động cuối nhằm nâng cao độ chính xác và tránh làm biến dạng vật phẩm thao tác.

Giá trị tham khảo

Đồ án tốt nghiệp là tài liệu tham khảo phù hợp cho:

  • Sinh viên các 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 đang thực hiện đồ án môn học hoặc khóa luận tốt nghiệp về thiết kế robot tay máy.
  • Kỹ sư và người nghiên cứu muốn xây dựng các mô hình robot 5 bậc tự do cỡ nhỏ phục vụ thí nghiệm hoặc ứng dụng gắp đặt chi tiết.

Các phần nội dung có giá trị tham khảo chuyên môn cao bao gồm:

  • Toàn bộ cơ sở lý thuyết ma trận thuần nhất và quy trình thiết lập phương trình động học thuận - ngược theo thông số D-H trong Chương 2.
  • Bảng thông số kỹ thuật thực nghiệm và phương thức điều khiển động cơ servo bánh răng kim loại MG996R trong Chương 3.

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

1. Động cơ servo MG996R sử dụng trong mô hình có những đặc tính kỹ thuật cơ bản nào?
Động cơ RC Servo MG996R là loại analog servo, điện áp hoạt động 4,6 VDC, trọng lượng 55 g, kích thước 40,9 mm. Động cơ cung cấp lực kéo 9,4 kgf·cm tại điện áp 4,8V và đạt 11 kgf·cm tại 6,0V (khoảng 108 N·cm). Tốc độ quay đạt 0,17 s/60° (ở 4,8V) và 0,14 s/60° (ở 6,0V không tải). Dòng điện hoạt động từ 500 mA đến 900 mA và dòng giữ mô-men tối đa là 2,5 A (tại 6,0V). Hệ thống truyền động sử dụng hoàn toàn bánh răng kim loại kết hợp vòng bi đôi.

2. Bốn thông số cơ bản trong phương pháp Denavit - Hartenberg (D-H) được tác giả sử dụng gồm những gì?
Bốn thông số D-H dùng để thiết lập mối quan hệ giữa hai trục khớp liên tiếp gồm:

  • $a_i$: Độ dài đường vuông góc chung giữa 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$ tính từ đường vuông góc chung giữa trục $(i-1, i)$ đến đường vuông góc chung giữa trục $(i, i+1)$ (là biến khớp nếu khớp $i$ là khớp trượt).
  • $\theta_i$: Góc quay giữa hai đường vuông góc chung nói trên quanh trục khớp $i$ (là biến khớp nếu khớp $i$ là khớp quay).

3. Ma trận chuyển đổi tọa độ thuần nhất 4x4 gồm những thành phần cấu trúc nào?
Ma trận chuyển đổi thuần nhất $T_{ij}$ kích thước $4 \times 4$ gồm bốn khối thành phần:

  • Ma trận $R_{ij}$ kích thước $3 \times 3$: Biểu thị phép biến đổi quay giữa hai hệ trục tọa độ.
  • Ma trận cột $P$ kích thước $3 \times 1$: Biểu thị tọa độ tịnh tiến của gốc hệ tọa độ mới so với hệ tọa độ ban đầu.
  • Ma trận hàng kích thước $1 \times 3$ gồm các phần tử $[0 \ 0 \ 0]$: Ma trận phối cảnh.
  • Thành phần tỉ lệ kích thước $1 \times 1$ có giá trị bằng 1: Thể hiện hệ số tỉ lệ ngầm định cho không gian mở rộng.

4. Khóa luận phân loại robot theo thế hệ thành những cấp bậc nào?
Văn bản phân loại robot thành 5 thế hệ:

  • Thế hệ thứ nhất: Hoạt động lặp lại theo chu trình định trước, điều khiển vòng hở, dùng tổ hợp cam và công tắc hành trình.
  • Thế hệ thứ hai: Điều khiển vòng kín, có cảm biến phản hồi để tự điều chỉnh thích ứng với môi trường.
  • Thế hệ thứ ba: Trang bị thuật toán xử lý phản xạ logic thích nghi và có hệ thống thu nhận hình ảnh mức thấp.
  • Thế hệ thứ tư: Sử dụng cơ chế điều khiển thích nghi theo mô hình tính toán xác định, bộ nhớ điều khiển lớn.
  • Thế hệ thứ năm: Robot ứng dụng trí tuệ nhân tạo, trang bị mạng nơ-ron tự học và giải thuật logic mờ (fuzzy logic).

5. Mô hình cánh tay robot của đồ án hướng tới những ứng dụng thực tế nào?
Mô hình hướng tới khả năng ứng dụng tự động phân loại sản phẩm trên băng chuyền theo màu sắc, hình dáng hoặc chia chọn sản phẩm đóng thùng. Ngoài ra, cơ cấu có thể phát triển cho các thao tác hàn, cắt, bốc dỡ phôi nhẹ trong sản xuất công nghiệp và đóng vai trò làm thiết bị thí nghiệm thực hành cho sinh viên chuyên ngành tự động hóa.

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 mục tiêu nghiên cứu và xây dựng mô hình cánh tay robot 5 bậc tự do, tập trung chuyên sâu vào giải pháp phần cứng cơ điện tử. Nghiên cứu đã hệ thống hóa cơ sở lý thuyết động học tay máy thông qua phương pháp tọa độ thuần nhất và quy tắc Denavit - Hartenberg, đồng thời hiện thực hóa thành công mô hình cơ khí sử dụng động cơ servo MG996R điều khiển qua vi xử lý Arduino. Kết quả của đồ án mang tính ứng dụng thực tiễn cao, đáp ứng tốt yêu cầu làm mô hình học cụ trực quan phục vụ công tác giảng dạy, nghiên cứu và thực hành chuyên ngành Điện Tự Động Công Nghiệp.