Xây dựng bản sao kỹ thuật số giám sát và điều khiển robot Yaskawa GP7

Đồ án xây dựng bản sao kỹ thuật số giám sát và điều khiển robot Yaskawa GP7 ĐH SPKT TP.HCM

• Tác giả: Hồ Minh Mẫn
• Người hướng dẫn: PGS. Vũ Văn Phong
• Trường học: Trường Đại học Sư phạm Kỹ thuật Thành phố Hồ Chí Minh
• Chuyên ngành: Công nghệ kỹ thuật điều khiển và tự động hóa
• Đề tài: Xây dựng bản sao kỹ thuật số giám sát và điều khiển robot Yaskawa GP7
• Loại tài liệu: Đồ án tốt nghiệp
• Năm xuất bản: 2025
• Địa điểm: Hồ Chí Minh

Tóm tắt

I. Tổng quan về bản sao kỹ thuật số robot Yaskawa GP7

Bản sao kỹ thuật số (Digital Twin) là mô hình ảo phản ánh chính xác trạng thái và hành vi của đối tượng vật lý trong thời gian thực. Trong lĩnh vực tự động hóa công nghiệp, công nghệ này đóng vai trò then chốt. Robot Yaskawa GP7 là robot công nghiệp 6 bậc tự do, được sử dụng rộng rãi trong các dây chuyền sản xuất hiện đại. Việc xây dựng bản sao kỹ thuật số cho GP7 giúp giám sát liên tục các thông số vận hành mà không cần can thiệp trực tiếp vào hệ thống thực. Đề tài này được thực hiện bởi sinh viên ngành Công nghệ Kỹ thuật Điều khiển và Tự động hóa tại Trường Đại học Sư phạm Kỹ thuật TP.HCM dưới sự hướng dẫn của PGS. Vũ Văn Phong. Hệ thống bản sao kỹ thuật số cho phép mô phỏng, phân tích và tối ưu hóa hiệu suất robot trước khi triển khai thực tế. Điều này giảm thiểu rủi ro sản xuất, tiết kiệm chi phí vận hành và nâng cao độ an toàn cho toàn bộ hệ thống. Môi trường Unity được lựa chọn làm nền tảng xây dựng mô hình 3D và giao diện điều khiển trực quan cho robot GP7.

1.1. Khái niệm và phân loại bản sao kỹ thuật số

Bản sao kỹ thuật số được phân loại theo bốn cấp độ chính. Cấp thành phần (Component Twin) tập trung vào từng chi tiết riêng lẻ như cảm biến, bộ truyền động. Cấp thiết bị (Asset Twin) đại diện cho máy móc hoàn chỉnh. Cấp hệ thống (System Twin) tích hợp nhiều thiết bị thành một mạng lưới vận hành thống nhất. Cấp quy trình (Process Twin) phản ánh toàn bộ luồng sản xuất. Mỗi cấp độ cung cấp góc nhìn khác nhau, hỗ trợ ra quyết định chính xác hơn trong quản lý và vận hành công nghiệp.

1.2. Robot Yaskawa GP7 và ứng dụng trong công nghiệp

Robot Yaskawa GP7 là robot cánh tay 6 bậc tự do, sở hữu tải trọng tối đa 7kg và tầm với 927mm. Thiết kế nhỏ gọn giúp GP7 phù hợp với không gian làm việc hạn chế trong nhà máy. Robot này được ứng dụng rộng rãi trong hàn, lắp ráp, xử lý vật liệu và kiểm tra chất lượng. Khả năng lặp lại chính xác cao cùng tốc độ vận hành nhanh giúp GP7 đáp ứng yêu cầu sản xuất khắt khe. Nhà sản xuất Yaskawa cung cấp đầy đủ tài liệu kỹ thuật và bản vẽ 3D, tạo điều kiện thuận lợi cho việc xây dựng mô hình số hóa chính xác.

II. Phân tích thách thức trong giám sát và mô hình hóa robot GP7

Giám sát robot công nghiệp trong môi trường sản xuất thực tế đặt ra nhiều thách thức kỹ thuật phức tạp. Hệ thống robot GP7 hoạt động liên tục với tốc độ cao, khiến việc thu thập và xử lý dữ liệu thời gian thực trở nên khó khăn. Đồng bộ hóa dữ liệu giữa mô hình ảo và robot vật lý đòi hỏi độ trễ truyền thông cực thấp. Ngoài ra, bài toán động học thuận và nghịch của robot 6 bậc tự do đòi hỏi tính toán ma trận biến đổi Denavit-Hartenberg (D-H) phức tạp. Mô hình hóa chính xác không gian làm việc và quỹ đạo chuyển động là yêu cầu cốt lõi. Việc chuyển đổi file thiết kế 3D từ định dạng STEP sang môi trường Unity thông qua SolidWorks cũng đặt ra yêu cầu cao về chất lượng mô hình hình học. Sai số trong mô hình hóa động học có thể dẫn đến lệch lạc giữa trạng thái robot ảo và robot thực, làm giảm hiệu quả giám sát toàn hệ thống.

2.1. Thách thức trong mô hình hóa động học robot

Động học robot GP7 bao gồm hai bài toán chính: động học thuận và động học nghịch. Động học thuận xác định vị trí đầu robot khi biết góc từng khớp. Động học nghịch phức tạp hơn, yêu cầu tính ngược các góc khớp từ vị trí và hướng mong muốn. Phương pháp D-H được áp dụng để biểu diễn mối quan hệ giữa các khâu. Với 6 bậc tự do, ma trận biến đổi thuần nhất có kích thước 4x4, đòi hỏi tính toán chính xác để tránh sai số tích lũy làm ảnh hưởng đến độ chính xác định vị của robot.

2.2. Vấn đề đồng bộ dữ liệu thời gian thực

Đồng bộ hóa giữa bản sao kỹ thuật số và robot vật lý đòi hỏi hạ tầng truyền thông đáp ứng thời gian thực. Giao thức kết nối phải đảm bảo độ trễ thấp và tính ổn định liên tục. Dữ liệu vị trí các khớp, mô-men xoắn và trạng thái vận hành phải được cập nhật liên tục. Bất kỳ gián đoạn nào trong luồng dữ liệu đều khiến mô hình ảo mất đồng bộ với thực tế. Vì vậy, thiết kế kiến trúc phần mềm truyền nhận dữ liệu đóng vai trò quyết định đến chất lượng hệ thống giám sát tổng thể.

III. Phương pháp xây dựng bản sao kỹ thuật số robot GP7 trong Unity

Quá trình xây dựng bản sao kỹ thuật số robot GP7 được thực hiện theo quy trình có hệ thống. Đầu tiên, tải bản vẽ 3D chính thức từ trang web của Yaskawa ở định dạng STEP. Tiếp theo, sử dụng phần mềm SolidWorks để tách rời các khối hình học, chuyển đổi từng bộ phận sang định dạng phù hợp với Unity. Môi trường Unity được lựa chọn vì khả năng render đồ họa thời gian thực và hỗ trợ lập trình C# linh hoạt. Mô hình động học được cài đặt dựa trên bảng thông số D-H của GP7, cho phép điều khiển chính xác từng khớp. Hệ thống giao diện người dùng (UI) được thiết kế trực quan, hiển thị góc các khớp và quỹ đạo chuyển động theo thời gian thực. Kết nối giữa Unity và bộ điều khiển robot thực được thiết lập qua giao thức truyền thông phù hợp, đảm bảo đồng bộ liên tục. Toàn bộ hệ thống tạo thành vòng lặp phản hồi kín giữa thế giới ảo và thực.

3.1. Quy trình chuyển đổi mô hình 3D và cài đặt trong Unity

Bản vẽ 3D GP7 từ Yaskawa được xử lý qua SolidWorks theo lưu đồ chuẩn: nhập file STEP, tách khối từng bộ phận, xuất sang định dạng Assembly, sau đó chuyển sang Unity. Trong Unity, các bộ phận được gắn khớp (Joint) và thiết lập hệ phân cấp đối tượng phản ánh cấu trúc cơ học thực tế. Script C# được viết để điều khiển góc quay từng khớp theo đầu vào từ thuật toán động học. Quá trình hiệu chỉnh đảm bảo mô hình ảo vận hành đồng nhất với robot vật lý về hành vi chuyển động và không gian làm việc.

3.2. Cài đặt thuật toán động học và điều khiển

Thuật toán động học thuận sử dụng bảng thông số D-H để tính ma trận biến đổi thuần nhất từ gốc tọa độ đến khâu cuối. Động học nghịch vị trí tách biệt với động học nghịch hướng để đơn giản hóa tính toán. Các góc khớp θ4, θ5, θ6 được xác định bằng hàm atan2 từ ma trận xoay. Trường hợp suy biến khi c5 = 1 được xử lý bằng cách cố định một góc và giải góc còn lại. Toàn bộ thuật toán được tích hợp vào Unity, tạo ra vòng lặp điều khiển phản hồi góc khớp liên tục và chính xác.

IV. Kết quả và ứng dụng thực tiễn của hệ thống bản sao kỹ thuật số

Hệ thống bản sao kỹ thuật số robot Yaskawa GP7 hoàn chỉnh mang lại nhiều giá trị thực tiễn quan trọng. Mô hình 3D trong Unity phản ánh chính xác cấu trúc cơ học và hành vi vận hành của robot thực tế. Giao diện giám sát trực quan cho phép theo dõi liên tục các thông số góc khớp, quỹ đạo và trạng thái hoạt động. Hệ thống hỗ trợ phát hiện sớm các bất thường trước khi xảy ra sự cố trên robot vật lý. Trong đào tạo, bản sao kỹ thuật số tạo môi trường thực hành an toàn, không rủi ro cho sinh viên và kỹ sư. Trong sản xuất, hệ thống hỗ trợ lập kế hoạch quỹ đạo, tối ưu hóa chu kỳ làm việc và giảm thời gian dừng máy. Đề tài này đặt nền tảng quan trọng cho việc tích hợp công nghệ Digital Twin vào các hệ thống robot công nghiệp tại Việt Nam, mở ra hướng nghiên cứu phát triển tiếp theo trong bối cảnh Công nghiệp 4.0.

4.1. Hiệu quả giám sát và phát hiện bất thường

Bản sao kỹ thuật số cho phép so sánh liên tục giữa trạng thái lý thuyết và trạng thái thực đo của robot. Khi xuất hiện sai lệch vượt ngưỡng, hệ thống phát cảnh báo tức thời. Điều này giúp đội ngũ vận hành phản ứng nhanh, tránh hỏng hóc nghiêm trọng. Dữ liệu lịch sử từ mô hình ảo còn hỗ trợ phân tích xu hướng suy giảm hiệu suất, từ đó lên kế hoạch bảo trì dự đoán thay vì bảo trì định kỳ thụ động, tiết kiệm chi phí và tăng tuổi thọ thiết bị.

4.2. Tiềm năng mở rộng và hướng phát triển tương lai

Hệ thống bản sao kỹ thuật số GP7 có thể mở rộng tích hợp trí tuệ nhân tạo để dự đoán lỗi và tự động tối ưu quỹ đạo. Kết hợp với nền tảng đám mây cho phép giám sát từ xa và quản lý đội robot quy mô lớn. Công nghệ này có thể nhân rộng sang các dòng robot Yaskawa khác hoặc các robot công nghiệp từ nhà sản xuất khác. Đây là bước tiến quan trọng hướng đến nhà máy thông minh (Smart Factory), nơi mọi thiết bị đều có phiên bản số hóa song song hoạt động liên tục.

Nội dung chính

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

Sự phát triển của khoa học và công nghệ đã thúc đẩy ứng dụng của robot trong nhiều lĩnh vực công nghiệp, y tế, quân sự và dịch vụ nhằm gia tăng năng suất và giảm thiểu rủi ro cho con người trong môi trường độc hại hoặc nguy hiểm. Trong công nghiệp hiện đại, nhu cầu giám sát và điều khiển robot từ xa đòi hỏi tính chính xác, kịp thời và trực quan cao. Công nghệ bản sao kỹ thuật số (Digital Twin) ra đời như một giải pháp mô phỏng thực thể vật lý trong không gian số theo thời gian thực, cho phép theo dõi, phân tích hiệu suất và hỗ trợ bảo trì dự đoán mà không cần can thiệp trực tiếp lên thiết bị thực. Xuất phát từ bối cảnh đó, đồ án "Xây dựng bản sao kỹ thuật số giám sát và điều khiển Robot Yaskawa GP7" tập trung thiết lập một mô hình số hóa đồng bộ với robot công nghiệp Yaskawa GP7 và bộ điều khiển YRC1000micro.

Mục tiêu nghiên cứu của đề tài được tác giả xác định cụ thể gồm 3 nội dung:

1. Xây dựng mô hình bản sao kỹ thuật số của Robot Yaskawa GP7.
2. Điều khiển Robot Yaskawa GP7 thông qua máy tính.
3. Kết nối đồng bộ mô hình bản sao kỹ thuật số và Robot Yaskawa GP7.

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

• Đối tượng nghiên cứu: Cánh tay robot công nghiệp 6 bậc tự do Yaskawa GP7, bộ điều khiển YRC1000micro, mô hình số hóa 3D trên môi trường Unity và các thuật toán giải động học.
• Phạm vi không gian: Nghiên cứu và thực nghiệm tại phòng thí nghiệm Bộ môn Tự động điều khiển, Khoa Điện – Điện tử, Trường Đại học Sư phạm Kỹ thuật TP. Hồ Chí Minh, với sự hỗ trợ về phần cứng và tài liệu kỹ thuật từ Công ty Yaskawa.
• Phạm vi thời gian: Đề tài được tiếp nhận thực hiện từ ngày 01/08/2024 và hoàn thành báo cáo vào ngày 06/01/2025.
• Giới hạn nghiên cứu: Đề tài tập trung vào việc nghiên cứu giao tiếp và thuật toán điều khiển trên nền tảng phần cứng có sẵn theo quy chuẩn của nhà sản xuất, không can thiệp sâu vào cấu trúc phần cứng của cánh tay robot hay mạch điều khiển nội tại. Về mặt động lực học, nghiên cứu chỉ giới hạn ở việc khảo sát, tính toán và kiểm chứng động học (động học thuận, động học nghịch), không phân tích chi tiết động lực học và tĩnh học của cánh tay robot.

---

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

Đồ án ứng dụng hệ thống lý thuyết về bản sao kỹ thuật số, kỹ thuật robot công nghiệp và giao thức truyền thông mạng:

• Khung lý thuyết về Bản sao kỹ thuật số (Digital Twin): Dựa trên định nghĩa do Michael Grieves giới thiệu năm 2002, hệ thống gồm 3 thành phần cốt lõi: Mô hình vật lý (Physical Object), Mô hình số (Digital Model) và Hệ thống điều khiển/giao tiếp (Controller). Bản sao kỹ thuật số được phân tầng thành 4 cấp độ: Component Twin (thành phần), Asset Twin (thiết bị), System Twin (hệ thống) và Process Twin (quy trình). Đề tài triển khai ở cấp độ Asset Twin cho một thiết bị cơ điện tử hoàn chỉnh.
• Lý thuyết động học robot: Áp dụng phương pháp Denavit – Hartenberg cải tiến (Modified Denavit-Hartenberg - DH) để thiết lập hệ tọa độ và xác định ma trận chuyển đổi đồng nhất giữa các khâu liên kết. Phép quay Euler ZYX với các góc xoay Roll, Pitch, Yaw được sử dụng để xác định hướng của khâu tác động cuối (End-Effector - EE). Phân tích cấu trúc cổ tay hình cầu (Spherical Wrist) tại điểm giao của ba trục khớp 4, 5, 6 để tách bài toán động học nghịch thành hai phần độc lập: giải vị trí cổ tay và giải hướng cổ tay.
• Giao thức truyền thông công nghiệp: Bộ điều khiển YRC1000micro sử dụng giao thức truyền thông TCP/IP qua mạng Ethernet (Ethernet Server Function), đảm bảo tính toàn vẹn dữ liệu thông qua cơ chế bắt tay ba bước (three-way handshake) và kiểm tra lỗi.
• Phương pháp nghiên cứu:
  • Phương pháp phân tích mô phỏng: Xây dựng mô hình toán học giải tích động học thuận và nghịch trên phần mềm MATLAB; chuyển đổi tệp thiết kế CAD của robot sang môi trường Unity để mô phỏng chuyển động và kiểm tra tính hợp lý của không gian làm việc.
  • Phương pháp thực nghiệm: Kết nối trực tiếp giữa máy tính điều khiển và bộ điều khiển YRC1000micro qua cáp Ethernet; thực hiện gửi nhận các gói lệnh điều khiển và giám sát trạng thái, sau đó đo lường độ phản hồi và so sánh vị trí giữa robot thực và mô hình ảo qua các bộ nghiệm góc khớp.
• Nguồn dữ liệu: Tài liệu kỹ thuật phần cứng, bản vẽ kích thước, phạm vi góc quay và hướng dẫn giao tiếp Ethernet của bộ điều khiển YRC1000micro do hãng Yaskawa cung cấp; bản vẽ mô hình 3D định dạng STEP của robot GP7 từ trang chủ Yaskawa.

---

Thiết kế và triển khai hệ thống kỹ thuật

Hệ thống được thiết kế theo cấu trúc tích hợp phần cứng và phần mềm, bao gồm các thành phần công nghệ:

1. Kiến trúc hệ thống

Hệ thống gồm 3 phân hệ chính:

• Thực thể vật lý: Robot công nghiệp Yaskawa GP7 kết nối với bộ điều khiển YRC1000micro.
• Bản sao số: Mô hình 3D của robot được xây dựng và mô phỏng trên nền tảng Unity 3D, tích hợp các thuật toán động học giải tích.
• Kênh truyền thông điều khiển: Mạng Ethernet sử dụng giao thức TCP/IP liên kết máy tính điều khiển với cổng mạng của bộ điều khiển YRC1000micro.

2. Xử lý mô hình và cài đặt trên Unity

• Xử lý mô hình CAD: Bản vẽ 3D định dạng STEP của Robot GP7 từ Yaskawa được nhập vào SolidWorks để chuyển đổi thành tệp lắp ghép (Assembly). Các chi tiết của từng khâu được tách rời, cố định gốc tọa độ và lưu sang định dạng tương thích với Unity.
• Chuẩn hóa hệ tọa độ trong Unity: Thiết lập lại trục xoay và vị trí gốc tọa độ của từng khớp trong môi trường Unity theo đúng các thông số trục xác định từ bảng DH, đảm bảo chiều quay của các khớp ảo trùng khớp với chiều quay vật lý của động cơ servo trên robot thực.
• Tích hợp giải thuật: Các phương trình giải động học thuận và động học nghịch được xây dựng trên MATLAB, sau đó chuyển giao và lập trình trực tiếp bằng ngôn ngữ C# trong môi trường Visual Studio gắn kết với các đối tượng trong Unity.

3. Cấu hình truyền thông Ethernet trên YRC1000micro

Để kích hoạt tính năng điều khiển từ bên ngoài, bộ điều khiển YRC1000micro được cấu hình thông qua các bước:

• Khởi động bộ điều khiển ở chế độ bảo trì (Maintenance Mode).
• Chuyển mức bảo mật (Security) sang chế độ quản lý (Management Mode).
• Truy cập cửa sổ Option Function để kích hoạt chức năng Ethernet Server Function.
• Cấu hình địa chỉ IP tĩnh và thông số mạng trong cửa sổ Ethernet Network.
• Giao tiếp dữ liệu theo thủ tục: Thiết bị điều khiển (Client) gửi yêu cầu khởi tạo START Request, bộ điều khiển YRC1000micro (Server) phản hồi xác nhận phiên, tiếp theo Client gửi các khối dữ liệu lệnh (Command Data) và nhận dữ liệu phản hồi (Response Data).
• Các lệnh điều khiển và giám sát được triển khai: Đọc trạng thái hoạt động (Data-1, Data-2), đọc vị trí góc của từng khớp (Joint Position), đọc cảnh báo lỗi (Alarm), lệnh điều khiển đóng/ngắt nguồn động lực (Servo ON/OFF) và lệnh điều khiển chuyển động vị trí khớp (PMOVJ).

4. Thiết kế giao diện người dùng (UI)

Giao diện được xây dựng trên Unity với các chức năng phân định rõ ràng:

• Khu vực hiển thị 3D: Hiển thị mô hình robot GP7 tương tác trong không gian ảo.
• Chế độ mô phỏng (Simulation Mode): Cho phép người dùng nhập trực tiếp giá trị góc của 6 khớp hoặc điều khiển tọa độ vị trí và hướng của điểm tác động cuối (EE/TCP) để quan sát chuyển động của robot ảo mà không tác động tới robot thực.
• Chế độ điều khiển robot thực: Bật/tắt Servo, thực thi các lệnh chuyển động đã được lập trình sẵn trên bộ điều khiển hoặc gửi tọa độ điều khiển trực tiếp.
• Chế độ giao tiếp - đồng bộ (Sync Mode): Điều khiển đồng thời robot thực và mô hình ảo theo hệ tọa độ khớp hoặc hệ tọa độ Descartes (TCP).
• Cửa sổ giám sát (Monitoring): Cập nhật liên tục trạng thái nguồn Servo, cảnh báo lỗi, giá trị góc quay của 6 khớp và tọa độ điểm cuối nhận về từ bộ điều khiển YRC1000micro theo thời gian thực.

---

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

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

Chương 1 giới thiệu vai trò của robot trong sản xuất công nghiệp, dịch vụ và y tế, đặt ra yêu cầu về việc giám sát và vận hành robot từ xa nhằm nâng cao độ an toàn và năng suất. Tác giả trình bày khái quát về công nghệ Digital Twin như một công cụ cầu nối giữa thực tế và mô phỏng số. Trên cơ sở đó, đồ án xác định rõ 3 mục tiêu nghiên cứu, giới hạn phạm vi đề tài vào việc điều khiển động học dựa trên phần cứng sẵn có của dòng robot Yaskawa GP7 mà không can thiệp sâu vào kết cấu cơ khí hay động lực học, đồng thời khái quát phương pháp phân tích mô phỏng kết hợp thực nghiệm qua 6 chương nội dung.

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

Chương này cung cấp hệ thống lý thuyết nền tảng cho toàn bộ đồ án, chia thành 5 nhóm nội dung chính:

1. Lý thuyết Bản sao kỹ thuật số: Phân tích định nghĩa, 3 thành phần cốt lõi (Mô hình vật lý, Mô hình số, Hệ thống điều khiển) và 4 cấp độ phân loại (Component, Asset, System, Process Twin), cùng các ứng dụng tiêu biểu trong sản xuất, y tế, xây dựng và đô thị thông minh.
2. Cánh tay robot công nghiệp: Phân loại các cấu hình robot phổ biến gồm robot khớp nối (Articulated), robot tọa độ Descartes, robot hình trụ và robot song song Delta. Trình bày khái niệm bậc tự do (DoF), quy tắc gán trục theo chuẩn Denavit-Hartenberg và ma trận chuyển đổi tọa độ tổng quát.
3. Tổng quan phần cứng: Giới thiệu đặc tính bộ điều khiển YRC1000micro với khả năng điều khiển tối đa 8 trục, thiết kế nhỏ gọn, tích hợp chức năng an toàn FSU và hỗ trợ đa giao thức mạng.
4. Thông số kỹ thuật của Robot Yaskawa GP7: Trình bày chi tiết các đặc tính vận hành do nhà sản xuất quy định.

Thông số kỹ thuật	Giá trị công bố
Số bậc tự do (Số trục)	6 trục
Tải trọng tối đa	7 kg
Độ lặp lại vị trí	±0.01 mm
Tầm với tối đa (Bán kính hoạt động)	927 mm
Khối lượng cánh tay robot	37 kg
Nguồn cấp điện	1 kVA
Dải nhiệt độ môi trường làm việc	0 – 45 ℃

5. Giao thức truyền thông và phần mềm ứng dụng: Trình bày nguyên lý bắt tay ba bước của TCP qua Ethernet; giới thiệu chức năng của các công cụ phần mềm: Unity (xây dựng không gian 3D và C# UI), MATLAB (tính toán động học), Visual Studio (môi trường lập trình IDE) và SolidWorks (chuyển đổi và xử lý tệp CAD 3D).

Chương 3: Mô hình hóa bản sao kỹ thuật số của Robot Yaskawa GP7

Nội dung chương 3 tập trung vào công tác giải tích động học và dựng mô hình hình học ảo:

• Thiết lập bảng Denavit-Hartenberg Modified (DH): Dựa vào cấu trúc hình học và vị trí các trục xoay của Robot GP7, tác giả xác lập các thông số liên kết giữa 6 khâu.

Khâu ($i$)	$a_{i-1}$ (mm)	$\alpha_{i-1}$ (độ)	$d_i$ (mm)	$\theta_i$ (độ)
1	0	0	$L_1$	$\theta_1$
2	$L_2$	90	0	$\theta_2 + 90^\circ$
3	$L_3$	0	0	$\theta_3$
4	$L_4$	90	$L_5$	$\theta_4$
5	0	-90	0	$\theta_5$
6	0	90	$L_6$	$\theta_6$

Kích thước chiều dài các thanh liên kết (Link) của Robot GP7:

Ký hiệu thanh link	$L_1$	$L_2$	$L_3$	$L_4$	$L_5$	$L_6$	$L_7$
Chiều dài (mm)	330	40	445	40	440	80	90

• Giải bài toán động học thuận: Nhân liên tiếp các ma trận chuyển đổi đồng nhất từ khâu 0 đến khâu 6 ($^0_6T = ^0_1T , ^1_2T , ^2_3T , ^3_4T , ^4_5T , ^5_6T$) để tìm vị trí và hướng của điểm tác động cuối ($P_{EE}$). Tác giả phân tích phép quay Euler ZYX và giải quyết hiện tượng khóa trục (Gimbal Lock) xuất hiện khi góc Pitch $RY = \pm 90^\circ$ bằng phương pháp gán biến độc lập.
• Giải bài toán động học nghịch: Sử dụng đặc tính cổ tay hình cầu (Spherical Wrist) tại điểm $W$ (giao điểm của trục $z_4, z_5, z_6$). Vị trí điểm $W$ được xác định dựa trên tọa độ $P_{EE}$ và hướng trục $z_6$: $^0W = , ^0P_{EE} - (L_6 + L_7) , ^0_6R_{[:,3]}$. Từ đó, giải ra các góc $\theta_1, \theta_2, \theta_3$. Hướng của cổ tay được xác định thông qua ma trận quay $^3_6R = (^0_3R)^{-1} , ^0_6R$ để triệt tiêu ảnh hưởng của 3 góc đầu, giải ra các góc $\theta_4, \theta_5, \theta_6$.
• Cài đặt trong Unity: Tải tệp STEP của Robot GP7 từ website của Yaskawa, sử dụng SolidWorks chuyển đổi thành tệp Assembly, tách rời từng bộ phận, đưa vào Unity và thiết lập lại hệ trục tọa độ phù hợp cho từng khớp xoay.

Chương 4: Giao tiếp giữa Robot GP7 và bản sao kỹ thuật số

Chương 4 mô tả chi tiết phương thức thiết lập kết nối truyền thông và lập trình giao diện:

• Cấu hình bộ điều khiển: Trình bày các bước đưa YRC1000micro vào chế độ bảo trì, mở quyền quản lý (Management Mode), bật tùy chọn Ethernet Server Function và cấu hình dải mạng nội bộ.
• Giao thức trao đổi dữ liệu: Phân tích cấu trúc các gói tin điều khiển bao gồm yêu cầu kết nối START Request, gói tin phản hồi từ Server, khung dữ liệu lệnh (Command Data) và khung phản hồi kết quả thực thi lệnh.
• Các hàm lệnh vận hành: Lập trình luồng thủ tục cho các tác vụ: Đọc cờ trạng thái hoạt động của hệ thống (lệnh đọc Data-1, Data-2), đọc vị trí góc hiện tại của 6 khớp, đọc mã cảnh báo lỗi (Alarm), kích hoạt nguồn Servo và lệnh truyền quỹ đạo chuyển động điểm-đến-điểm theo góc khớp (PMOVJ).
• Phát triển giao diện: Thiết kế không gian làm việc trực quan trên Unity với đầy đủ các bảng điều khiển cho từng chế độ: mô phỏng độc lập theo khớp/TCP, điều khiển phần cứng thực tế và đồng bộ dữ liệu song song hai chiều.

Chương 5: Đánh giá kết quả

Chương 5 trình bày toàn bộ kết quả thử nghiệm thực tế:

• Kiểm chứng động học trên bản sao số: Thử nghiệm động học thuận và nghịch với hàng loạt tư thế góc khớp khác nhau: $[0^\circ, 0^\circ, 0^\circ, 0^\circ, 0^\circ, 0^\circ]$, $[-90^\circ, 0^\circ, 0^\circ, 0^\circ, 0^\circ, 0^\circ]$, $[-30^\circ, 0^\circ, 0^\circ, 0^\circ, 0^\circ, 0^\circ]$, $[0^\circ, -90^\circ, 0^\circ, 0^\circ, 0^\circ, 0^\circ]$, $[0^\circ, 0^\circ, 90^\circ, 0^\circ, 0^\circ, 0^\circ]$, $[45^\circ, 0^\circ, 0^\circ, -90^\circ, -90^\circ, 0^\circ]$. Đối với động học nghịch, chương trình tính toán và kiểm chứng đầy đủ 8 bộ nghiệm khả dĩ ứng với cùng một tọa độ điểm cuối $P_{EE}$.
• Kiểm chứng giao tiếp và đồng bộ với Robot GP7 thực: Kết nối hệ thống thực tế tại các cấu hình góc khớp kiểm tra: $[-90^\circ, 15^\circ, 0^\circ, 0^\circ, 0^\circ, 0^\circ]$, $[-90^\circ, 0^\circ, -30^\circ, 0^\circ, 0^\circ, 0^\circ]$, $[-90^\circ, 0^\circ, 0^\circ, -90^\circ, 0^\circ, 0^\circ]$, $[-90^\circ, 0^\circ, 0^\circ, 0^\circ, -90^\circ, 0^\circ]$, $[-90^\circ, 0^\circ, 0^\circ, 0^\circ, 0^\circ, -90^\circ]$, $[-45^\circ, 0^\circ, 0^\circ, 0^\circ, -45^\circ, 0^\circ]$.
• Đánh giá đáp ứng hệ thống: Đánh giá độ trễ và khả năng đáp ứng đồng bộ chuyển động của robot thực và mô hình số hóa ở cả hai chế độ: Chế độ giám sát (robot thực gửi vị trí về cho robot ảo bám theo) và Chế độ điều khiển (robot ảo gửi lệnh điều khiển robot thực chuyển động).

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

Chương cuối tóm tắt các kết quả đạt được của đồ án so với mục tiêu đề ra ban đầu, nêu rõ các mặt hạn chế còn tồn tại và vạch ra các định hướng nghiên cứu tiếp theo để hoàn thiện hệ sinh thái bản sao kỹ thuật số.

---

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

1. Kết quả đạt được

• Xây dựng thành công mô hình 3D bản sao kỹ thuật số của robot Yaskawa GP7 với đầy đủ 6 bậc tự do trên nền tảng Unity từ mô hình CAD gốc, chuẩn hóa chính xác hệ trục tọa độ của từng khớp quay theo phương pháp DH Modified.
• Giải quyết trọn vẹn bài toán động học thuận và động học nghịch cho robot 6 bậc tự do có cổ tay hình cầu, xử lý triệt để hiện tượng Gimbal Lock và tìm ra chính xác 8 bộ nghiệm cấu hình góc khớp cho một vị trí điểm cuối.
• Thiết lập kênh giao tiếp truyền thông hai chiều thời gian thực qua giao thức TCP/IP giữa phần mềm điều khiển trên máy tính và bộ điều khiển YRC1000micro qua chức năng Ethernet Server Function.
• Phát triển giao diện điều khiển và giám sát người dùng với đầy đủ các chế độ: mô phỏng góc khớp độc lập, mô phỏng theo điểm cuối TCP, điều khiển robot thực tế và đồng bộ chuyển động hai chiều với độ trễ thấp.
• Thực nghiệm đồng bộ thành công giữa robot thực Yaskawa GP7 và bản sao số qua nhiều cấu hình tư thế kiểm chứng từ đơn khớp đến đa khớp.

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

• Cung cấp một phương pháp luận hoàn chỉnh từ khâu xử lý mô hình CAD, tính toán giải tích động học đến lập trình điều khiển trên Unity cho cánh tay robot công nghiệp Yaskawa.
• Mở ra khả năng giám sát và điều khiển trực quan robot Yaskawa từ xa thông qua phần mềm tùy biến trên máy tính cá nhân qua mạng Ethernet mà không cần phụ thuộc vào thiết bị cầm tay Teach Pendant tiêu chuẩn.
• Đóng góp một nền tảng thực nghiệm hỗ trợ giảng dạy, nghiên cứu và thử nghiệm thuật toán điều khiển robot trong môi trường ảo trước khi đưa vào ứng dụng thực tế.

---

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

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

• Nghiên cứu chỉ dừng lại ở phạm vi động học thuần túy (Kinematics), chưa mô hình hóa và tính toán đến các yếu tố động lực học (Dynamics) như khối lượng, trọng tâm, lực quán tính, ma sát và mô-men xoắn của từng khớp trong quá trình chuyển động.
• Chưa trang bị thêm các hệ thống cảm biến ngoại vi để đo lường các thông số thực tế của môi trường hoặc trạng thái tải trọng của robot.
• Hệ thống phụ thuộc vào việc cấu hình mạng cục bộ có dây và các hàm giao tiếp cố định do hãng Yaskawa cung cấp trên bộ điều khiển YRC1000micro.

2. Hướng nghiên cứu tiếp

• Nghiên cứu và tích hợp các phương trình động lực học vào mô hình bản sao kỹ thuật số để mô phỏng chính xác mô-men xoắn và lực tác động trong quá trình vận hành.
• Ứng dụng các thuật toán trí tuệ nhân tạo (AI) và học máy (Machine Learning) để phân tích dữ liệu lịch sử vận hành, từ đó phát hiện sự cố sớm và thực hiện bảo trì dự đoán cho robot.
• Mở rộng chức năng nhận dạng vật cản trong không gian làm việc thực tế và tự động quy hoạch quỹ đạo tối ưu cho cánh tay robot.

---

Giá trị tham khảo

Đồ án là tài liệu kỹ thuật có giá trị thực tiễn cao cho:

• Đối tượng thụ hưởng: Sinh viên, học viên cao học, giảng 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 và Hệ thống Nhúng.
• Giá trị chuyên môn theo phần:
  • Chương 3: Cung cấp phương pháp chi tiết, rõ ràng về các bước thiết lập bảng DH cải tiến, ma trận chuyển đổi đồng nhất và phương pháp giải động học nghịch tách vị trí/hướng cho robot 6 trục có cổ tay hình cầu, cùng quy trình chuẩn hóa trục xoay từ tệp CAD SolidWorks sang Unity.
  • Chương 4: Hướng dẫn cụ thể quy trình mở khóa bảo mật, thiết lập chức năng Ethernet Server Function và cấu trúc các gói tin điều khiển của bộ điều khiển YRC1000micro, giúp các kỹ sư làm việc với thiết bị Yaskawa dễ dàng xây dựng phần mềm điều khiển chuyên dụng bằng C#.

---

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

1. Robot Yaskawa GP7 trong đồ án có những thông số kỹ thuật cơ bản nào về tải trọng, phạm vi hoạt động và độ chính xác?
Robot Yaskawa GP7 là dòng robot công nghiệp 6 bậc tự do, có tải trọng nâng tối đa 7 kg, độ lặp lại vị trí đạt ±0.01 mm, phạm vi hoạt động tối đa 927 mm, trọng lượng bản thân 37 kg và sử dụng nguồn điện công suất 1 kVA.

2. Phương pháp giải bài toán động học nghịch của Robot GP7 trong đề tài dựa trên đặc điểm cấu tạo cơ học nào?
Phương pháp giải dựa trên đặc điểm robot sở hữu cơ cấu cổ tay hình cầu (Spherical Wrist), nghĩa là 3 trục xoay của khớp 4, khớp 5 và khớp 6 giao nhau tại một điểm duy nhất (điểm cổ tay $W$). Đặc điểm này cho phép tách bài toán động học nghịch thành hai giai đoạn độc lập: tính 3 góc đầu ($\theta_1, \theta_2, \theta_3$) dựa vào tọa độ vị trí của điểm cổ tay $W$, sau đó triệt tiêu ảnh hưởng của 3 góc đầu để tính 3 góc còn lại ($\theta_4, \theta_5, \theta_6$) dựa vào ma trận định hướng của khâu tác động cuối.

3. Để thiết lập giao tiếp truyền thông Ethernet giữa máy tính và bộ điều khiển YRC1000micro, tác giả đã cấu hình các chế độ bảo mật nào?
Tác giả khởi động bộ điều khiển ở chế độ bảo trì (Maintenance Mode), sau đó nâng cấp quyền bảo mật của hệ thống từ mức thông thường lên chế độ quản lý (Management Mode). Khi đạt quyền này, mục Option Function mới cho phép kích hoạt chức năng Ethernet Server Function để trao đổi dữ liệu qua mạng LAN.

4. Hiện tượng khóa trục (Gimbal Lock) xuất hiện khi nào trong quá trình tính toán và tác giả xử lý như thế nào?
Hiện tượng khóa trục xuất hiện khi góc quay Pitch quanh trục Y đạt giá trị $RY = \pm 90^\circ$ trong biểu diễn góc Euler ZYX, khiến hai trục xoay bị trùng phương và mất đi một bậc tự do quay. Tác giả giải quyết bằng cách gán cố định một trong hai góc ($RX$ hoặc $RZ$) bằng $0^\circ$, sau đó áp dụng hàm $\text{atan2}$ với các phần tử ma trận tương ứng để tính góc xoay còn lại.

5. Lệnh điều khiển nào được sử dụng trong chương trình để di chuyển cánh tay robot thực tế theo cấu hình góc khớp?
Chương trình sử dụng lệnh vận hành PMOVJ thông qua giao thức Ethernet Server Function để gửi dữ liệu mảng góc của các khớp từ máy tính xuống bộ điều khiển YRC1000micro, thực hiện điều khiển robot di chuyển điểm-đến-điểm theo tọa độ khớp.

---

Kết luận

Đồ án tốt nghiệp "Xây dựng bản sao kỹ thuật số giám sát và điều khiển Robot Yaskawa GP7" đã hoàn thành toàn diện việc xây dựng mô hình số hóa 3D trực quan của cánh tay robot 6 bậc tự do trên nền tảng Unity và SolidWorks. Nghiên cứu đã giải quyết chính xác bài toán động học thuận - nghịch cho robot và thiết lập thành công kênh truyền thông hai chiều ổn định qua giao thức TCP/IP với bộ điều khiển YRC1000micro. Kết quả thử nghiệm thực tế chứng minh hệ thống có khả năng giám sát trạng thái và điều khiển đồng bộ chính xác giữa robot thực tế và bản sao số trong không gian làm việc. Đây là tài liệu kỹ thuật có giá trị ứng dụng cao cho việc nghiên cứu và triển khai công nghệ Digital Twin trong tự động hóa công nghiệp.

Trích đoạn nội dung tài liệu

Chương 1: Tổng quan đề tài. Chương 2: Cơ sở lý thuyết. Chương 3: Mô hình hóa bản sao kỹ thuật số của Robot Yaskawa GP7. Chương 4: Giao tiếp giữa Robot GP7 và bản sao kỹ thuật số Chương 5: Thử nghiệm và đánh giá kết quả.

Chương 6: Kết luận và hướng phát triển. BỘ MÔN ĐIỀU KHIỂN TỰ ĐỘNG 3 CHƯƠNG 2: CƠ SỞ LÝ THUYẾT CHƯƠNG 2. Tổng quan về bản sao kỹ thuật số (Digital Twin) 2. Khái niệm về bản sao kỹ thuật số (Digital Twin) Bản sao kỹ thuật số (Digital Twin) là một khái niệm trong lĩnh vực công nghệ cao, mô tả sự kết nối và song song giữa thế giới thực và thế giới số.

Hiểu một cách đơn giản, đây là một bản sao mô hình của một thực thể vật lý, chẳng hạn như các máy móc, thiết bị…Bản sao này không chỉ mô phỏng hình dáng bên ngoài mà còn bao gồm các dữ liệu vận hành, hiệu năng và các yếu tố khác của thực thể đó. 1 Khái niệm bản sao kỹ thuật số Khái niệm Digital Twin được giới thiệu lần đầu vào năm 2002 mời Micheal Grieves tại Học viện Đại học Michigan. Mục tiêu chính của Digital Twin là cung cấp một cái nhìn chi tiết theo thời gian thực và toàn diện về thực thể vật lý, từ đó tăng hiệu quả sản xuất, tối ưu hóa hiệu năng và báo cáo sự cố. Bản sao kỹ thuật số bao gồm các mô hình thích nghi, mô phỏng hành vi của hệ thống vật lý trong môi trường ảo, hoạt động như một đối tác số với mục đích phục vụ các nhiệm vụ như mô phỏng, tích hợp, thử nghiệm, giám sát và bảo trì.

Bản sao kỹ thuật số không chỉ là một mô hình tĩnh mà còn mang tính tương tác cao. Thông qua các cảm biến, dữ liệu thực thể thực được chuyển đến bản saokyx thuật số, cho phép giám sát và đánh giá theo thời gian thực. Ngoài ra, Digital Twin còn được sử dụng để thực hiện các mô phỏng, thử nghiệm trong môi trường số, giúp giảm thiểu chi phí và nguy cơ trong quá tình vận hành thực tế. BỘ MÔN ĐIỀU KHIỂN TỰ ĐỘNG 4 CHƯƠNG 2: CƠ SỞ LÝ THUYẾT 2.

Các thành phần chính trong bản sao kỹ thuật số (Digital Twin) Bản sao kỹ thuật số là một hệ thống phức hợp, trong đó hai thành phần chính là mô hình vật lý (Physical Object) và mô hình số (Digital Model) đóng vai trò cốt lõi. Physical Model đại diện cho đối tượng thực tế, có thể là một robot, máy móc, hay một quy trình vận hành trong công nghiệp. Đây là nguồn dữ liệu thực tế, cung cấp thông tin về trạng thái, hành vi, và các yếu tố tác động từ môi trường xung quanh. 2 Đặc điểm bản sao kỹ thuật số Đặc điểm của mô hình vật lý: • Có thể tương tác trực tiếp với môi trường như thực hiện các nhiệm vụ hàn, sơn, lắp ráp, vận chuyển sản phẩm… và chịu ảnh hưởng từ các yếu tố môi trường như nhiệt độ, độ ẩm, sự mài mòn cơ học… • Có thể sử dụng các giao thức như Modbus, TCP/IP… để giao tiếp với các hệ thống khác.

• Có thể cung cấp và lưu trữ các loại dữ liệu như trạng thái, hiệu suất, lỗi… và cả các dữ liệu về môi trường như nhiệt độ, độ ẩm, dòng điện… nhờ các cảm biển đo lường. • Cần được bảo trì định kỳ để hoạt động ổn định, tránh sự cố. • Có thể được tích hợp với các hệ sinh thái công nghiệp như hệ thống điều khiển, hệ thống giảm sát SCADA, IoT… Digital Model, ngược lại, là phiên bản số hóa của đối tượng vật lý, được xây dựng thông qua các công cụ mô phỏng và thiết kế như CAD, SOLIDWORK hoặc các phần mềm chuyên dụng khác.