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

Trong bối cảnh công nghiệp hóa và hiện đại hóa, robot công nghiệp đóng vai trò nòng cốt trong việc nâng cao năng suất, độ chính xác và tính linh hoạt của các dây chuyền sản xuất tự động. Theo số liệu từ Liên đoàn Robot Quốc tế (IFR), mật độ robot trong ngành sản xuất toàn cầu đã tăng từ 66 robot trên 10.000 lao động năm 2015 lên 77 robot trên 10.000 lao động vào năm 2017. Tại Việt Nam, việc ứng dụng các dòng tay máy công nghiệp (robot manipulators), robot cộng tác (cobots) và phát triển mô hình nhà máy thông minh đang trở thành xu hướng tất yếu tại các doanh nghiệp chế tạo, lắp ráp cơ khí, sản xuất ô tô và y tế.

Robot 6 bậc tự do (6-DOF) có cấu hình không ràng buộc (trục quay của 3 khớp cuối không đồng quy tại một điểm) như mẫu robot Universal Robots UR3 mang lại độ linh hoạt cao và khả năng thao tác đa hướng trong không gian làm việc hẹp. Tuy nhiên, cấu hình này dẫn đến bài toán động học nghịch (Inverse Kinematics - IK) rất phức tạp, mang tính phi tuyến cao. Phương pháp giải tích/đại số cổ điển thường gặp khó khăn khi có sự thay đổi về kích thước cơ khí, đồng thời dễ gặp tình trạng kỳ dị hoặc tiêu tốn nhiều thời gian tính toán. Do đó, việc nghiên cứu phương pháp số học thông minh để giải bài toán động học nghịch kết hợp với thiết kế, chế tạo mô hình thực nghiệm là yêu cầu kỹ thuật có ý nghĩa thực tiễn.

Đề tài đặt ra các mục tiêu và nhiệm vụ nghiên cứu cụ thể sau:

  1. Tính toán và thiết kế phần cứng mô hình robot 6 bậc tự do DRC3 phỏng theo nguyên lý và hình dáng robot UR3.
  2. Tìm hiểu giải thuật, tính toán động học thuận, động học nghịch và thực hiện mô phỏng chuyển động trên phần mềm MATLAB.
  3. Áp dụng giải thuật động học nghịch thông minh trên máy tính, truyền thông với bộ điều khiển vi xử lý và quy hoạch quỹ đạo điều khiển mô hình thực nghiệm hoạt động ổn định.

Đối tượng nghiên cứu của đề tài là mô hình robot 6 bậc tự do mô phỏng cấu hình UR3 và thuật toán giải động học nghịch thông minh. Phạm vi nghiên cứu bao gồm việc hoàn thiện cơ cấu cơ khí cánh tay robot, xây dựng tủ điện điều khiển, lập trình giao diện giám sát trên máy tính và thuật toán nhúng điều khiển vị trí/quỹ đạo. Đề tài giới hạn ở việc chế tạo mô hình bằng vật liệu nhựa in 3D kết hợp khung kim loại nhằm phục vụ mục đích nghiên cứu thực nghiệm trong phòng thí nghiệm, điều chỉnh kết cấu chịu lực ở các khớp dưới và giảm tải trọng các khớp trên so với phiên bản thương mại.

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

Khóa luận xây dựng trên các nền tảng lý thuyết và công cụ kỹ thuật chuyên ngành:

  • Lý thuyết động học robot: Thiết lập bảng thông số Denavit-Hartenberg (D-H), xây dựng các ma trận biến đổi thuần nhất $^{i-1}iT$ để giải bài toán động học thuận (Forward Kinematics - FK) xác định vị trí và hướng của khâu thao tác cuối ($P{ee}$).
  • Lý thuyết động học nghịch: Phương pháp đại số giải hệ phương trình lượng giác để tìm các góc khớp $\theta_1 \dots \theta_6$; thuật toán tối ưu hóa phi tuyến Levenberg-Marquardt (LM) với việc cải tiến ma trận tốc độ học $\Xi$ thông qua quy tắc học thích nghi (Self-learning Levenberg-Marquardt - SLM).
  • Lý thuyết điều khiển tự động và quy hoạch quỹ đạo: Hệ thống điều khiển vòng kín, các phương pháp quy hoạch quỹ đạo không gian khớp sử dụng đa thức bậc 3 (điều kiện biên về vị trí và vận tốc) và đa thức bậc 5 (bổ sung điều kiện biên về gia tốc triệt tiêu tại điểm đầu và điểm cuối).
  • Công cụ phần mềm: MATLAB phục vụ tính toán ma trận và mô phỏng không gian 3D qua lệnh plot3D(); SOLIDWORKS dùng để thiết kế mô hình 3D và trích xuất định dạng STL phục vụ in 3D; Visual Studio (C#) xây dựng giao diện điều khiển giám sát; Arduino IDE lập trình vi điều khiển.

Phương pháp nghiên cứu kết hợp giữa mô hình hóa toán học, mô phỏng số và thực nghiệm kỹ thuật:

  • Phương pháp phân tích lý thuyết: Thiết lập mô hình toán học giải tích và giải thuật lặp xấp xỉ chuyển vị dựa trên ma trận Jacobian.
  • Phương pháp mô phỏng: Thiết lập các kịch bản kiểm chứng tĩnh và bám quỹ đạo động trên MATLAB, so sánh tốc độ hội tụ và sai số giữa thuật toán Levenberg-Marquardt truyền thống (CLM) và thuật toán Levenberg-Marquardt tự học (SLM).
  • Phương pháp thiết kế và chế tạo thực nghiệm: Thiết kế từng cụm khớp, xuất file in 3D, tích hợp động cơ AC Servo, bộ điều khiển động cơ (Driver), mạch cách ly quang và vi điều khiển điều khiển chuyển động thực tế.

Nguồn dữ liệu tham chiếu chính bao gồm thông số hình học của robot UR3 từ Universal Robots, thông số kỹ thuật của dòng động cơ Servo Mitsubishi HC-KFS053, HC-KFS13 và Driver Mitsubishi MR-J2S-10A.

Thiết kế và triển khai

Hệ thống điều khiển và phần cứng của robot DRC3 được thiết kế theo cấu trúc phân tầng:

[Giao diện C# trên PC] 
[Vi điều khiển Arduino Due] 
[Mạch cách ly Opto quang] 
[Bộ điều khiển Driver MR-J2S-10A] 
[Động cơ AC Servo (HC-KFS053, HC-KFS13) & Cơ cấu 6 khớp]

Kiến trúc phần cứng và thiết kế cơ khí

  • Cơ cấu chấp hành và khung vỏ: Cánh tay robot gồm 6 khớp quay tương ứng với 6 bậc tự do, nối với nhau bằng các thanh liên kết. Các chi tiết phức tạp được mô hình hóa trên phần mềm SOLIDWORKS, sau đó chuyển đổi sang định dạng STL để in 3D bằng vật liệu nhựa. Robot được cố định trên khung giá đỡ bằng gỗ nhằm giảm rung lắc khi chuyển động.
  • Hệ thống truyền động: Sử dụng động cơ AC Servo Mitsubishi HC-KFS053 và HC-KFS13 kết hợp với Driver MR-J2S-10A, cung cấp mô-men xoắn và khả năng phản hồi vị trí chính xác.
  • Mạch đệm và xử lý tín hiệu: Tích hợp các mạch Opto quang cách ly giữa mạch điều khiển logic điện áp thấp và tầng công suất của Driver nhằm triệt tiêu xung nhiễu công nghiệp.

Kiến trúc phần mềm và thuật toán điều khiển

  • Phần mềm giao diện (C# WinForms): Đảm nhận vai trò nhập tọa độ mục tiêu $(P_x, P_y, P_z)$ và ma trận hướng của điểm đầu cuối; thực thi thuật toán giải động học nghịch thông minh SLM để tính toán tập góc $\theta_1 \dots \theta_6$; gửi các giá trị góc này xuống bộ điều khiển qua giao thức nối tiếp.
  • Phần mềm nhúng (Arduino Due): Tiếp nhận dữ liệu góc đặt từ máy tính, thực hiện bài toán quy hoạch quỹ đạo (nội suy chuyển động theo thời gian) và phát xung điều khiển chính xác đến từng Driver động cơ theo chu kỳ lấy mẫu định trước.

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

Chương 1: Tổng quan đề tài

Chương này tổng thuật lịch sử phát triển của robot từ những khái niệm đầu tiên năm 1920 qua tác phẩm của Karel Capek, cánh tay máy Unimate năm 1954 của George Devol, cho đến các dòng robot công nghiệp hiện đại. Tác giả trình bày cấu trúc chung của robot công nghiệp gồm thân, cánh tay, khâu thao tác, hệ thống dẫn động, cảm biến và hệ thống điều khiển; phân loại theo không gian làm việc và phương thức điều khiển. Chương 1 nêu rõ các bài toán cơ bản trong kỹ thuật robot (động học, động lực học, quy hoạch quỹ đạo và điều khiển), đồng thời giới thiệu đặc tính của robot UR3 và xác định mục tiêu chế tạo mô hình DRC3 6-DOF.

Chương 2: Cơ sở lý thuyết

Chương 2 trình bày nguyên lý hoạt động tổng thể của hệ thống từ khâu nhập tọa độ trên giao diện máy tính đến khâu chấp hành tại khớp quay. Tác giả giới thiệu quy trình thiết kế cơ khí bằng SOLIDWORKS và xuất file in 3D định dạng STL. Chương này hệ thống hóa lý thuyết điều khiển tự động (khái niệm tín hiệu vào, tín hiệu ra, hồi tiếp, phân loại hệ hở/kín, hệ liên tục/rời rạc), cấu trúc phần mềm tính toán MATLAB và phương pháp quy hoạch quỹ đạo điểm-điểm bằng đa thức bậc 3 và bậc 5 nhằm làm mượt chuyển động, triệt tiêu gia tốc đột biến ở hai đầu hành trình.

Chương 3: Tính toán, mô phỏng và kiểm chứng động học của robot bằng MATLAB

Chương này thiết lập bảng thông số D-H gồm 6 khớp và xây dựng các ma trận biến đổi thuần nhất $^{i-1}_iT$, từ đó xác định ma trận vị trí và hướng $^0_6T$. Đối với bài toán động học nghịch:

  • Phương pháp đại số: Tìm ra 8 bộ nghiệm hình học cho 6 góc khớp tương ứng với các cấu hình lật khớp khác nhau.
  • Phương pháp thông minh: Ứng dụng thuật toán Levenberg-Marquardt cải tiến (SLM) với công thức cập nhật góc:

$$\theta[k+1] = \theta[k] + \Xi J_r^T[k] \left( J_r[k]J_r^T[k] + \gamma I_{12} \right)^{-1} (f_d - f[k])$$

Trong đó ma trận học $\Xi$ được xây dựng thích nghi gồm 3 thành phần: số dương tĩnh $\Xi_s$, số dương bù trừ $\Xi_o$, và mức động học $\Xi_d$ ($\Xi = \Xi_s + \Xi_o + \Xi_d$).

Chương này trình bày kết quả mô phỏng so sánh giữa CLM và SLM trên MATLAB: trong thử nghiệm tĩnh, CLM cần 18.000 vòng lặp để hội tụ trong khi SLM chỉ cần 4.000 vòng lặp. Trong thử nghiệm bám quỹ đạo giới hạn 100 vòng lặp, sai số xác lập của CLM là ~2 mm còn SLM đạt mức ~0,3 mm.

Chương 4: Thiết kế và thi công mô hình DRC3 robot

Chương 4 trình bày chi tiết cấu tạo cơ khí từng khớp từ khớp 1 đến khớp 6 của robot DRC3, giải pháp gia công in 3D các chi tiết gá lắp và truyền động đai. Tác giả mô tả thông số kỹ thuật của động cơ AC Servo Mitsubishi HC-KFS053, HC-KFS13, Driver MR-J2S-10A, bộ vi điều khiển Arduino Due, sơ đồ mạch cách ly sử dụng Opto quang và môi trường phát triển phần mềm giao tiếp C# Visual Studio 2017.

Chương 5: Điều khiển robot DRC3 - 6DOF

Chương 5 mô tả quy trình kết nối phần cứng thực tế giữa vi điều khiển, mạch Opto, Driver và tủ điện điều khiển. Tác giả trình bày cấu trúc giao diện điều khiển viết bằng C#, cho phép người dùng giám sát trạng thái hoạt động, nhập tọa độ không gian làm việc hoặc điều khiển trực tiếp từng góc khớp của robot DRC3.

Chương 6: Kết quả và hướng phát triển

Chương cuối tổng kết các kết quả đạt được sau quá trình thi công và thử nghiệm: hoàn thiện cánh tay robot 6 bậc hoạt động thực tế, lắp ráp tủ điện điều khiển hoàn chỉnh và thực hiện thử nghiệm điều khiển robot vẽ quỹ đạo hình tròn trong không gian. Chương này cũng chỉ ra các điểm cần hoàn thiện về kết cấu cơ khí và đề xuất hướng nghiên cứu tiếp theo.

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

Kết quả tính toán và thử nghiệm thực nghiệm

  1. Giải quyết bài toán động học: Thiết lập thành công bảng D-H và giải thuật động học thuận; xác định 8 bộ nghiệm bằng phương pháp đại số và xây dựng thành công thuật toán động học nghịch thông minh SLM.
  2. Hiệu năng thuật toán SLM so với CLM:
Chỉ số so sánh Thuật toán CLM (Truyền thống) Thuật toán SLM (Tự học đề xuất)
Số vòng lặp hội tụ (Thử nghiệm tĩnh) 18.000 vòng lặp 4.000 vòng lặp
Sai số xác lập (Quỹ đạo giới hạn 100 vòng) ~2,0 mm ~0,3 mm
Quy tắc cập nhật ma trận học $\Xi$ Cố định/thông thường Thích nghi 3 mức ($\Xi_s + \Xi_o + \Xi_d$)
Khả năng bám điểm mốc Hội tụ chậm Hội tụ nhanh, sai số triệt tiêu nhanh
  1. Chế tạo và vận hành mô hình thực tế: Xây dựng hoàn chỉnh mô hình robot 6 bậc tự do DRC3 phỏng theo UR3, tích hợp tủ điện điều khiển với driver MR-J2S-10A, động cơ Servo HC-KFS053/HC-KFS13 và điều khiển thực nghiệm thành công quỹ đạo hình tròn.

Đóng góp kỹ thuật của đề tài

  • Ứng dụng thành công thuật toán Levenberg-Marquardt tự học cải tiến (SLM) vào bài toán động học nghịch cho robot 6 bậc tự do không ràng buộc, khắc phục được sự phụ thuộc vào việc tính toán lại nghiệm giải tích khi thay đổi kích thước các khâu liên kết.
  • Hiện thực hóa quy trình thiết kế - chế tạo hoàn chỉnh từ mô hình 3D (SOLIDWORKS), xuất in 3D (STL), lập trình giao diện giám sát cấp cao (C#), lập trình nhúng xử lý quỹ đạo (Arduino Due) đến điều khiển hệ truyền động AC Servo công nghiệp.

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

Khóa luận ghi nhận các hạn chế kỹ thuật trong quá trình thực hiện:

  • Do sử dụng vật liệu nhựa in 3D nên độ cứng vững cơ khí của các khâu chưa cao, dễ bị biến dạng đàn hồi nhẹ khi chịu tải trọng hoặc chuyển động nhanh.
  • Thời gian thực hiện đồ án có hạn nên chưa khắc phục triệt để các sai số cơ khí chế tạo nhỏ ở các khớp truyền động.
  • Hệ thống thực nghiệm chưa tích hợp thuật toán bù sai số động lực học và chưa trang bị các cảm biến ngoại tín hiệu (cảm biến thị giác, cảm biến lực) để nhận biết môi trường làm việc.

Hướng nghiên cứu tiếp theo được đề xuất:

  • Cải tiến kết cấu cơ khí bằng vật liệu kim loại gia công chính xác để nâng cao độ cứng vững và độ lặp lại vị trí.
  • Nghiên cứu tích hợp mô hình động lực học vào giải thuật điều khiển nhằm tối ưu hóa mô-men xoắn và điện năng tiêu thụ.
  • Phát triển thêm hệ thống cảm biến lực và camera giám sát (Robot Vision) phục vụ các tác vụ gắp đặt tự động trong không gian thực.

Giá trị tham khảo

Đồ án tốt nghiệp này là tài liệu tham khảo phù hợp cho sinh viên, học viên và kỹ sư thuộc các chuyên ngành:

  • Công nghệ Kỹ thuật Điều khiển và Tự động hóa, Cơ điện tử, Kỹ thuật Robot: Tham khảo phương pháp xây dựng bảng D-H, tính toán ma trận chuyển đổi và giải thuật động học nghịch thông minh Levenberg-Marquardt tự học trên MATLAB.
  • Kỹ thuật phần mềm nhúng và hệ thống điều khiển: Tham khảo giải pháp kết nối truyền thông nối tiếp giữa phần mềm C# WinForms và vi điều khiển Arduino Due, cũng như kỹ thuật ghép nối vi điều khiển với Driver AC Servo Mitsubishi qua mạch cách ly Opto quang.

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

1. Khóa luận giải quyết bài toán động học nghịch cho robot DRC3 bằng những phương pháp nào?
Tác giả đã giải quyết bài toán động học nghịch bằng hai phương pháp: phương pháp đại số cổ điển (cho ra 8 bộ nghiệm hình học) và phương pháp số học thông minh sử dụng thuật toán Levenberg-Marquardt tự học (SLM) dựa trên ma trận Jacobian và quy tắc xấp xỉ chuyển vị.

2. Thuật toán Levenberg-Marquardt tự học (SLM) cải tiến điểm gì so với thuật toán Levenberg-Marquardt truyền thống (CLM)?
Thuật toán SLM bổ sung quy tắc tự học bậc thấp để tự động cập nhật ma trận học $\Xi$ theo 3 mức: số dương tĩnh $\Xi_s$, số dương bù trừ $\Xi_o$, và mức động học $\Xi_d$ ($\Xi = \Xi_s + \Xi_o + \Xi_d$). Nhờ đó, thuật toán giảm số vòng lặp hội tụ từ 18.000 vòng (ở CLM) xuống còn 4.000 vòng và giảm sai số bám quỹ đạo từ ~2 mm xuống còn ~0,3 mm trong thử nghiệm giới hạn 100 vòng lặp.

3. Khóa luận sử dụng các thuật toán quy hoạch quỹ đạo nào cho chuyển động của robot?
Khóa luận nghiên cứu và trình bày hai phương pháp quy hoạch quỹ đạo không gian khớp: đa thức bậc 3 (ràng buộc vị trí và vận tốc đầu/cuối bằng 0) và đa thức bậc 5 (bổ sung ràng buộc gia tốc đầu/cuối bằng 0 nhằm loại bỏ rung giật cơ khí).

4. Cấu hình phần cứng chính của hệ thống điều khiển robot DRC3 gồm những thiết bị nào?
Hệ thống bao gồm máy tính chạy giao diện C# Visual Studio 2017, vi điều khiển Arduino Due, mạch đệm cách ly sử dụng Opto quang, bộ điều khiển Driver Mitsubishi MR-J2S-10A, các động cơ AC Servo Mitsubishi HC-KFS053 và HC-KFS13, cùng khung vỏ robot gia công bằng công nghệ in 3D.

5. Robot DRC3 được thiết kế phỏng theo nguyên lý của dòng robot công nghiệp nào?
Robot DRC3 được thiết kế mô phỏng theo cấu hình động học của robot Universal Robots UR3 – một dòng robot cộng tác 6 bậc tự do không ràng buộc với khả năng quay $\pm 360^\circ$ tại các khớp và quay vô cực ở khớp cuối.

Kết luận

Khóa luận tốt nghiệp của sinh viên Đặng Sỹ Bình đã hoàn thành đầy đủ các mục tiêu đề ra trong việc nghiên cứu lý thuyết, tính toán động học và chế tạo thực nghiệm cánh tay robot 6 bậc tự do DRC3 dựa trên cấu hình robot UR3. Việc đề xuất và ứng dụng thuật toán Levenberg-Marquardt tự học (SLM) đã chứng minh được hiệu quả vượt trội về tốc độ hội tụ và giảm thiểu sai số tính toán động học nghịch so với phương pháp truyền thống. Mặc dù còn một số hạn chế về độ cứng vững của vật liệu in 3D, đề tài đã xây dựng thành công một mô hình thực nghiệm hoàn chỉnh từ phần mềm giám sát, bộ điều khiển nhúng đến hệ truyền động AC Servo công nghiệp, cung cấp cơ sở kỹ thuật có giá trị cho các nghiên cứu tiếp theo về điều khiển robot nhiều bậc tự do.