Bối cảnh và vấn đề nghiên cứu
Trong xu thế hiện đại hóa các dây chuyền sản xuất tự động, robot công nghiệp đóng vai trò quan trọng nhằm nâng cao năng suất, đảm bảo chất lượng sản phẩm và tối ưu hóa chi phí vận hành. Bên cạnh các loại tay máy nối tiếp (serial manipulators) truyền thống, robot song song (parallel manipulators) thu hút sự quan tâm lớn trong nghiên cứu học thuật và ứng dụng công nghiệp nhờ những đặc tính vượt trội về độ cứng vững kết cấu, khả năng chịu tải cao, quán tính chuyển động thấp và độ chính xác định vị. Tuy nhiên, tại các nhà máy và cơ sở sản xuất ở Việt Nam, việc triển khai ứng dụng các cơ cấu robot song song còn hạn chế do giá thành nhập khẩu thiết bị hoàn chỉnh từ nước ngoài rất cao.
Đề tài "Robot Tripteron: Thiết kế, Chế tạo & Điều khiển" (tên tiếng Anh: Designing, Creating, and Controlling the Tripteron Robot) được nhóm sinh viên ngành Kỹ thuật Cơ điện tử, Khoa Đào tạo Chất lượng cao, Trường Đại học Sư phạm Kỹ thuật TP.HCM thực hiện nhằm giải quyết bài toán tiếp cận, làm chủ công nghệ thiết kế, mô hình hóa toán học và chế tạo thực nghiệm dòng robot song song Tripteron 3 bậc tự do tịnh tiến (3-DOF Translational Parallel Manipulator).
Mục tiêu và nhiệm vụ nghiên cứu cụ thể của đề tài bao gồm:
- Nghiên cứu tổng quan lý thuyết về cơ cấu robot song song và các biến thể hình học của cấu hình Tripteron (Orthogonal, Monorail, Collinear, Quadrupteron).
- Xây dựng mô hình toán học giải tích: giải bài toán động học thuận (Forward Kinematics), động học ngược (Inverse Kinematics) và phân tích động lực học (Dynamics) bằng phương pháp Newton-Euler.
- Tính toán, lựa chọn phương án kết cấu cơ khí và thiết kế 3D hoàn chỉnh trên phần mềm Autodesk Inventor; tính chọn bàn trượt vitme bi, khung nhôm định hình và động cơ bước NEMA 23.
- Thiết kế sơ đồ nguyên lý mạch điện điều khiển trên phần mềm Proteus; phối ghép phần cứng gồm vi điều khiển Arduino Uno, bo mở rộng CNC Shield V3 và driver TB6600.
- Xây dựng thuật toán điều khiển và lập trình giao diện giám sát, điều khiển trên máy tính bằng ngôn ngữ C# (Visual Studio).
- Quy hoạch quỹ đạo chuyển động (quỹ đạo đa thức bậc 3, quỹ đạo đường thẳng, quỹ đạo tròn) và tiến hành chế tạo mô hình thực tế.
- Thực nghiệm đo đạc, đánh giá độ chính xác vị trí và khả năng bám quỹ đạo của mô hình thực tế.
Đối tượng và phạm vi nghiên cứu:
- Đối tượng nghiên cứu: Cơ cấu robot song song Tripteron 3 bậc tự do tịnh tiến với cấu hình 3 nhánh độc lập, cơ cấu dẫn động trực giao và khâu chấp hành cuối.
- Phạm vi không gian: Không gian làm việc danh định của mô hình thiết kế là $300 \times 300 \times 300\text{ mm}$.
- Phạm vi thời gian: Đề tài được triển khai từ ngày 15/03/2023 đến ngày 28/07/2023.
Cơ sở lý thuyết và phương pháp
Khung lý thuyết của đề tài tập trung vào việc mô hình hóa các đặc tính động học, động lực học và quy hoạch quỹ đạo cho cơ cấu robot song song Tripteron trực giao:
- Cấu trúc chuỗi động học: Robot Tripteron gồm 3 nhánh động học giống nhau nối từ đế cố định đến khâu chấp hành cuối (End-Effector - EE). Mỗi nhánh là một chuỗi nối tiếp cấu hình $PRRR$, trong đó $P$ là khớp trượt chủ động (Prismatic joint) và $R$ là các khớp quay thụ động (Revolute joints). Trục của các khớp quay trên cùng một nhánh song song với hướng dịch chuyển của khớp trượt tương ứng. Ba trục trượt được bố trí trực giao trong không gian Descartes.
- Phân tích bậc tự do (Mobility Analysis): Sử dụng công thức Chebychev–Grübler–Kutzbach cho chuỗi động học không gian: $$M = s(n - j - 1) + \sum_{i=1}^{j} \lambda_i$$ Trong đó $s = 6$ (bậc tự do của vật thể tự do trong không gian), $n = 11$ (số khâu), $j = 12$ (số khớp, gồm 3 khớp $P$ và 9 khớp $R$), $\lambda_i = 1$ (bậc tự do của mỗi khớp). Kết quả tính toán cho ra $M = 0$, chứng minh Tripteron về mặt lý thuyết là một cơ cấu thừa liên kết (over-constrained mechanism).
- Mô hình động học: Sử dụng phương pháp ma trận biến đổi tọa độ thuần nhất để xác định vị trí khâu chấp hành cuối cho từng nhánh ($T_{limb1}, T_{limb2}, T_{limb3}$). Nhờ cấu hình trực giao, ma trận Jacobian của cơ cấu bằng ma trận đơn vị ($J = I$), giúp chuyển động giữa các trục hoàn toàn tách rời (fully decoupled) và không gian làm việc không xuất hiện điểm kỳ dị (singularity-free). Bài toán động học ngược được rút gọn trực tiếp thành quan hệ tuyến tính: $d_x = x_e$, $d_y = y_e$, $d_z = z_e$.
- Mô hình động lực học: Áp dụng phương pháp Newton-Euler để thiết lập hệ phương trình vi phân cân bằng lực và mô-men tác động lên từng khâu của các nhánh (khâu dưới $l_x$, khâu trên $u_x$, đế trượt $p_x$) và khâu chấp hành cuối $EE$, từ đó xác định lực dẫn động cần thiết ($\mathcal{F}{px}, \mathcal{F}{py}, \mathcal{F}_{pz}$) tại các cơ cấu trượt.
- Quy hoạch quỹ đạo: Sử dụng phương pháp đa thức bậc 3 (Cubic polynomial) để nội suy vị trí $q(t) = a_3 t^3 + a_2 t^2 + a_1 t + a_0$ với điều kiện vận tốc ban đầu và kết thúc bằng 0 ($\dot{q}(t_0) = 0, \dot{q}(t_f) = 0$). Đối với quỹ đạo tròn bán kính $R$, tâm $O(X_c, Y_c, Z_c)$, quy hoạch vị trí được xác định thông qua vận tốc góc $\omega = 0.5\text{ rad/s}$.
Phương pháp nghiên cứu thực tế được triển khai theo quy trình:
- Phương pháp nghiên cứu tài liệu 3 bước (Three-pass approach) để thu thập, phân loại và phân tích các nghiên cứu quốc tế về cơ cấu Tripteron.
- Phương pháp giải tích kết hợp mô phỏng số trên môi trường MATLAB để kiểm chứng không gian làm việc và quỹ đạo chuyển động.
- Phương pháp thiết kế kỹ thuật (CAD/CAE) trên Autodesk Inventor và Proteus.
- Phương pháp chế tạo thực nghiệm và đo kiểm sai số trực tiếp trên mô hình vật lý.
Thiết kế và triển khai
Hệ thống robot Tripteron được triển khai tích hợp giữa kết cấu cơ khí chính xác, mạch điện điều khiển và phần mềm giao diện điều khiển trên máy tính.
| Thành phần | Thông số kỹ thuật / Giải pháp lựa chọn |
|---|---|
| Kích thước tổng thể khung | Chiều rộng: 440 mm, Chiều cao: 410 mm |
| Chiều dài khâu nhánh 1 (Link 1) | 250 mm |
| Chiều dài khâu nhánh 2 (Link 2) | 270 mm |
| Vật liệu khung | Nhôm định hình $40 \times 40\text{ mm}$ |
| Tổng khối lượng hệ thống | Khoảng 15 kg |
| Không gian làm việc thiết kế | $300 \times 300 \times 300\text{ mm}$ |
| Cơ cấu dẫn động tịnh tiến | Bàn trượt vitme bi thép (Ball screw slide table), trục $D = 16\text{ mm}$, bước vít $P = 5\text{ mm}$, chiều dài $L = 300\text{ mm}$, cấp chính xác $\Delta l = \pm 0.025\text{ mm}$ |
| Động cơ dẫn động | Động cơ bước NEMA 23 (3 động cơ cho 3 trục $X, Y, Z$) |
| Bộ điều khiển công suất | Driver TB6600 (cấu hình vi bước và giới hạn dòng điện) |
| Bộ điều khiển trung tâm | Vi điều khiển Arduino Uno R3 kết hợp bo mạch mở rộng CNC Shield V3 |
| Giao diện điều khiển (GUI) | Ứng dụng C# phát triển trên nền tảng Visual Studio |
Khung máy được chế tạo từ nhôm định hình $40 \times 40\text{ mm}$ đảm bảo độ cứng vững khi hệ thống vận hành. Khâu chấp hành cuối được thiết kế dạng tấm tam giác đều để gá đặt 3 khớp quay vuông góc và làm vị trí lắp đầu công tác.
Hệ thống điện được thiết kế nguyên lý và mô phỏng trên Proteus trước khi lắp ráp tủ điện. Arduino Uno giao tiếp với máy tính qua cổng nối tiếp (Serial COM), nhận lệnh từ phần mềm C# và xuất xung điều khiển (PUL/DIR) đến 3 driver TB6600 để điều khiển độc lập 3 động cơ bước NEMA 23.
Phần mềm điều khiển C# hỗ trợ các chế độ làm việc:
- Manual Mode: Điều khiển di chuyển thủ công từng trục $X, Y, Z$ theo bước nhảy xác định.
- Auto (Set Points) Mode: Di chuyển tự động đầu công tác đến các tọa độ $(X, Y, Z)$ định trước.
- Save Point Feature: Ghi nhận và lưu trữ các điểm tọa độ làm việc để tái sử dụng trong chu trình.
- Trajectory Mode: Lập trình chuyển động theo quỹ đạo liên tục (quỹ đạo hình chữ nhật, quỹ đạo hình tròn).
- Set Home: Đưa 3 trục về vị trí gốc tọa độ chuẩn của hệ thống.
Nội dung chính theo từng chương
Chapter I: Introduction (Giới thiệu đề tài)
Chương 1 trình bày tính cấp thiết của việc nghiên cứu robot song song trong bối cảnh tự động hóa tại Việt Nam. Nội dung nêu rõ lý do lựa chọn cơ cấu Tripteron, mục tiêu chế tạo mô hình thực nghiệm hoàn chỉnh, ý nghĩa khoa học và thực tiễn, đối tượng, phạm vi nghiên cứu, cấu trúc báo cáo 7 chương cùng phương pháp đọc tài liệu khoa học 3 bước (Three-pass approach).
Chapter II: Overview of Parallel Robot and Tripteron (Tổng quan về Robot song song và Tripteron)
Chương 2 tổng hợp cơ sở lý thuyết về robot song song và nguồn gốc cơ cấu Tripteron phát minh tại Đại học Laval (Canada). Tác giả phân tích các ưu điểm của Tripteron như cơ cấu truyền động gắn trực tiếp trên đế giúp giảm quán tính khâu động, độ chính xác đồng đều trong không gian làm việc và điều khiển tách rời. Chương này cũng phân tích các biến thể quốc tế gồm Orthogonal Tripteron, Monorail Tripteron, Collinear Tripteron và Quadrupteron cùng các ứng dụng tiềm năng trong cứu hộ, kiểm tra công nghiệp và in 3D.
Chapter III: Theoretical Basis and Options to Design (Cơ sở lý thuyết và Phương án thiết kế)
Chương 3 trình bày các định nghĩa về động lực học (phương pháp Newton-Euler), động học thuận và động học ngược. Tác giả tiến hành so sánh và đánh giá 3 phương án thiết kế kết cấu cơ khí:
- Option 1: Sử dụng các linh kiện rời tự chế tạo; chi phí thấp nhưng kết cấu lỏng lẻo, thiếu ổn định và tính thẩm mỹ kém.
- Option 2: Sử dụng bàn trượt kích thước lớn; chịu tải tốt nhưng cồng kềnh, chi phí cao và khó lắp ráp.
- Option 3 (Phương án chọn): Sử dụng kết cấu bàn trượt vitme bi thương mại kết hợp khung nhôm định hình $40 \times 40\text{ mm}$; đảm bảo độ cứng vững, kết cấu nhỏ gọn, tính thẩm mỹ cao và đáp ứng giới hạn ngân sách.
Chapter IV: Calculation and Design (Tính toán và Thiết kế chi tiết)
Chương 4 tập trung vào việc mô hình hóa toán học và tính toán kỹ thuật:
- Chứng minh bậc tự do cơ cấu $M = 0$ bằng công thức Chebychev–Grübler–Kutzbach.
- Thiết lập hệ phương trình động lực học Newton-Euler cân bằng lực và mô-men cho các khâu và khâu chấp hành cuối.
- Xác lập ma trận chuyển đổi tọa độ động học thuận ($T_{limb1}, T_{limb2}, T_{limb3}$) và công thức giải tích động học ngược cho 3 nhánh.
- Mô phỏng không gian làm việc trên MATLAB (ghi nhận kích thước trục $X, Y$ đạt 300 mm, trục $Z$ đạt gần 100 mm).
- Thiết lập phương trình quy hoạch quỹ đạo đa thức bậc 3 cho các trục và phương trình quỹ đạo tròn.
- Tính toán sức bền trục vitme bi và tính chọn mô-men động cơ bước NEMA 23.
Chapter V: Electrical Circuit and Control Algorithm (Thiết kế mạch điện và Thuật toán điều khiển)
Chương 5 trình bày thiết kế phần cứng điều khiển và xây dựng thuật toán:
- Bản vẽ thiết kế nguyên lý mạch điện trên phần mềm Proteus.
- Sơ đồ kết nối phần cứng giữa Arduino Uno, CNC Shield V3, 3 driver TB6600 và hệ thống cấp nguồn.
- Xây dựng lưu đồ giải thuật cho các chế độ vận hành: chế độ Manual, chế độ Auto (Position), chế độ Set Home.
- Thiết kế giao diện điều khiển người dùng trên Visual Studio C#.
Chapter VI: Experiments and Evaluations (Thực nghiệm và Đánh giá)
Chương 6 trình bày các kết quả thử nghiệm thực tế trên mô hình chế tạo:
- Đo kiểm độ chính xác vị trí ở chế độ Auto (set points) và đánh giá độ lặp lại của tính năng Save point.
- Thực nghiệm bám quỹ đạo hình chữ nhật và quỹ đạo đường tròn.
- Thu thập số liệu vị trí các trục $X, Y, Z$, trích xuất biểu đồ sai số vị trí trục $X$ và trục $Y$ theo thời gian thực để đánh giá chất lượng truyền động và độ chính xác của hệ thống.
Chapter VII: Conclusion and Development (Kết luận và Hướng phát triển)
Chương 7 tổng kết toàn bộ quá trình nghiên cứu, thiết kế, chế tạo và thử nghiệm robot Tripteron. Tác giả đánh giá mức độ hoàn thành nhiệm vụ đồ án và đề xuất các giải pháp nâng cấp trong tương lai.
Kết quả và đóng góp
Đồ án đã đạt được các kết quả cụ thể:
| Hạng mục | Kết quả đạt được |
|---|---|
| Mô hình toán học | Hoàn thành hệ thống phương trình động học thuận, động học ngược dạng giải tích và hệ phương trình động lực học Newton-Euler cho cơ cấu Tripteron trực giao. |
| Sản phẩm phần cứng | Chế tạo hoàn chỉnh 01 mô hình robot Tripteron vật lý: khối lượng ~15 kg, khung nhôm $40 \times 40\text{ mm}$, Link 1 = 250 mm, Link 2 = 270 mm, tích hợp 3 bàn trượt vitme bi bước 5 mm và 3 động cơ bước NEMA 23. |
| Hệ thống điều khiển | Lắp ráp tủ điện hoàn chỉnh với Arduino Uno, CNC Shield V3 và driver TB6600; lập trình giao diện C# kết nối Serial COM đáp ứng các chế độ Manual, Auto, Save point, Trajectory và Set Home. |
| Kết quả thực nghiệm | Hệ thống thực thi thành công việc định vị điểm và bám các quỹ đạo mẫu (hình chữ nhật, đường tròn $\omega = 0.5\text{ rad/s}$); xuất biểu đồ phân tích sai số trục $X$ và $Y$. |
Đóng góp của đề tài:
- Hệ thống hóa toàn diện cơ sở lý thuyết động học, động lực học và quy hoạch quỹ đạo cho dòng robot song song Tripteron bằng ngôn ngữ tiếng Anh trong chương trình đào tạo chất lượng cao.
- Đưa ra giải pháp kỹ thuật khả thi trong việc chế tạo cơ cấu Tripteron tại Việt Nam bằng cách sử dụng bàn trượt vitme bi thương mại thay cho cơ cấu truyền động đai, giúp nâng cao độ cứng vững kết cấu và giảm thiểu sai số tích lũy.
Hạn chế và hướng nghiên cứu tiếp
Hạn chế của đề tài:
- Không gian làm việc trục Z bị thu hẹp: Không gian làm việc thực tế của trục $Z$ chỉ đạt xấp xỉ 100 mm (trong khi mô phỏng thiết kế ban đầu là 300 mm) do giới hạn góc gập hình học của các khâu liên kết ($Link\ 1$, $Link\ 2$) khi di chuyển theo phương thẳng đứng.
- Điều khiển vòng hở (Open-loop): Hệ thống sử dụng động cơ bước không có encoder phản hồi vị trí tuyệt đối tại các khớp quay thụ động, do đó việc bù sai số động lực học trong quá trình chuyển động tốc độ cao còn hạn chế.
Hướng nghiên cứu tiếp:
- Tối ưu hóa kích thước chiều dài các khâu và vị trí bố trí bàn trượt để mở rộng không gian làm việc trục $Z$ đạt đầy đủ $300\text{ mm}$.
- Nâng cấp hệ thống truyền động sang động cơ servo hoặc động cơ bước có phản hồi vòng kín (closed-loop) nhằm tăng độ chính xác bám quỹ đạo.
- Tích hợp thêm đầu công tác chuyên dụng như cơ cấu gắp đặt linh kiện (Pick and Place) hoặc đầu đùn in 3D (3D printing hotend) để ứng dụng vào sản xuất thực tế.
Giá trị tham khảo
Báo cáo khóa luận là tài liệu tham khảo hữu ích cho sinh viên, học viên cao học và các kỹ sư thuộc các ngành:
- Kỹ thuật Cơ điện tử và Kỹ thuật Robot: Tham khảo quy trình phân tích động học, động lực học Newton-Euler cho cơ cấu song song $PRRR$ trực giao; phương pháp mô phỏng không gian làm việc trên MATLAB và quy hoạch quỹ đạo chuyển động.
- Kỹ thuật Điều khiển và Tự động hóa: Tham khảo giải pháp phối ghép phần cứng điều khiển nhiều trục dùng Arduino Uno, CNC Shield V3, driver TB6600 và kỹ thuật lập trình giao diện giám sát C# qua giao thức truyền thông nối tiếp.
- Kỹ thuật Cơ khí: Tham khảo phương pháp tính chọn trục vitme bi, tính chọn công suất động cơ bước và kết cấu khung nhôm định hình chịu lực.
Câu hỏi thường gặp
1. Cơ cấu Tripteron trong đồ án có cấu trúc chuỗi động học như thế nào và tại sao lại là cơ cấu thừa liên kết?
Robot Tripteron gồm 3 nhánh động học giống nhau nối từ đế đến khâu chấp hành cuối. Mỗi nhánh có cấu trúc $PRRR$ gồm 1 khớp trượt chủ động và 3 khớp quay thụ động có trục song song với hướng trượt. Khi áp dụng công thức Chebychev–Grübler–Kutzbach cho hệ không gian ($s = 6, n = 11, j = 12$), số bậc tự do tính toán được là $M = 0$. Về mặt lý thuyết cơ học, đây là cơ cấu thừa liên kết (over-constrained mechanism) nhưng vẫn chuyển động được nhờ tính chất hình học trực giao đặc thù của các khớp.
2. Tại sao động học ngược của cấu hình Tripteron trực giao lại được xem là tách rời hoàn toàn?
Trong cấu hình trực giao (Orthogonal Tripteron), ba trục trượt chủ động được bố trí vuông góc từng đôi một trùng với các trục tọa độ Descartes ($X, Y, Z$). Mỗi động cơ dẫn động trực tiếp tịnh tiến một hướng độc lập, làm cho ma trận Jacobian của hệ thống là ma trận đơn vị ($J = I$). Do đó, tọa độ của khâu chấp hành cuối liên hệ trực tiếp tuyến tính với vị trí các bàn trượt ($d_x = x_e, d_y = y_e, d_z = z_e$) mà không bị phụ thuộc chéo, loại bỏ hoàn toàn các điểm kỳ dị trong không gian làm việc.
3. Nhóm tác giả đã lựa chọn phương án thiết kế cơ khí nào và các thông số kích thước chính là bao nhiêu?
Nhóm tác giả chọn Phương án 3 (Option 3): sử dụng khung nhôm định hình $40 \times 40\text{ mm}$ (kích thước khung bao rộng 440 mm, cao 410 mm, tổng khối lượng khoảng 15 kg), kết hợp 3 bàn trượt vitme bi thép đường kính trục 16 mm, bước vít 5 mm, chiều dài 300 mm. Chiều dài khâu thứ nhất ($Link\ 1$) là 250 mm và khâu thứ hai ($Link\ 2$) là 270 mm.
4. Hệ thống điều khiển và phần mềm của robot Tripteron được triển khai như thế nào?
Phần cứng điều khiển sử dụng vi điều khiển Arduino Uno kết hợp bo mở rộng CNC Shield V3 và 3 driver TB6600 điều khiển 3 động cơ bước NEMA 23. Phần mềm giám sát được lập trình bằng C# trên Visual Studio, giao tiếp qua cổng COM với vi điều khiển, hỗ trợ các chế độ: Manual (chạy tay), Auto (chạy theo điểm tọa độ), Save Point (lưu điểm làm việc), Trajectory (chạy quỹ đạo chữ nhật, đường tròn) và Set Home.
5. Điểm khác biệt chính giữa không gian làm việc mô phỏng và thực tế của robot là gì?
Trên mô phỏng thiết kế lý thuyết, không gian làm việc mục tiêu là hình hộp chữ nhật $300 \times 300 \times 300\text{ mm}$. Tuy nhiên, khi phân tích trên MATLAB và đo đạc mô hình thực tế, không gian chuyển động trục $X$ và trục $Y$ đạt 300 mm, nhưng không gian trục $Z$ chỉ đạt gần 100 mm do góc gập giới hạn của các khâu cơ khí $Link\ 1$ và $Link\ 2$ khi co rút theo phương thẳng đứng.
Kết luận
Đồ án tốt nghiệp "Robot Tripteron: Thiết kế, Chế tạo & Điều khiển" đã hoàn thành trọn vẹn các mục tiêu nghiên cứu từ xây dựng mô hình toán học giải tích, tính toán kết cấu cơ khí đến chế tạo mô hình vật lý 3 bậc tự do tịnh tiến hoàn chỉnh. Nhóm tác giả đã tích hợp thành công hệ thống phần cứng điều khiển Arduino/TB6600 với giao diện phần mềm C#, cho phép robot vận hành linh hoạt ở nhiều chế độ định vị và bám quỹ đạo. Dù không gian làm việc trục $Z$ còn hạn chế so với lý thuyết, công trình là tài liệu thực nghiệm giá trị đối với việc nghiên cứu và ứng dụng dòng robot song song Tripteron trong lĩnh vực cơ điện tử và tự động hóa.