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

Trong xu hướng tự động hóa sản xuất hiện đại, robot công nghiệp một cánh tay truyền thống bộc lộ những giới hạn nhất định khi thực hiện các thao tác đòi hỏi sự kết hợp phức tạp hoặc tương tác đa hướng tương tự như con người. Việc nghiên cứu hệ hai cánh tay robot (dual-arm robot) có khả năng làm việc đồng bộ trở thành một nhu cầu cấp thiết nhằm đáp ứng các công đoạn như lắp ráp cụm chi tiết ô tô, hộp số, hàn, đóng gói và vận chuyển các vật thể kích thước lớn.

Trên thế giới, các tập đoàn và viện nghiên cứu đã phát triển nhiều hệ thống cánh tay đôi tiên tiến: tập đoàn Yaskawa (Nhật Bản, năm 2008) giới thiệu hệ thống hai cánh tay 6 bậc tự do (6-DOF) kèm 1 thân 2 bậc tự do (Torso 2-DOF) có khối lượng 10 kg mỗi cánh tay; Viện DLR (Đức) phát triển hệ hai cánh tay 7 bậc tự do (7-DOF) tích hợp thị giác máy và cảm biến lực/moment. Tại Việt Nam, nghiên cứu về hệ cánh tay robot đồng bộ còn khá mới mẻ; năm 2019 có công trình điều khiển chế độ trượt dựa trên mạng thần kinh thích ứng cho robot hai cánh tay của nhóm tác giả thuộc Đại học Bách khoa Hà Nội, Cao đẳng Công nghiệp Quốc phòng và Đại học Công nghệ Úc; năm 2021 có đề tài đồng bộ hệ hai cánh tay robot hai bậc tự do của sinh viên Trường Đại học Sư phạm Kỹ thuật TP. Hồ Chí Minh. Nhằm mở rộng không gian làm việc và khả năng phối hợp chuyển động, đề tài "Thiết kế mô hình và điều khiển đồng bộ chủ tớ cho hệ hai cánh tay robot bốn bậc tự do" được thực hiện.

Mục đích của đề tài là ứng dụng các kiến thức về Robot, Hệ thống điều khiển tự động và Vi xử lý để xây dựng bộ điều khiển đồng bộ cho hệ hai cánh tay robot bốn bậc tự do (4-DOF). Đề tài xác định các mục tiêu và nhiệm vụ nghiên cứu cụ thể bao gồm:

  1. Thiết kế mô hình cánh tay robot bốn bậc tự do và lựa chọn linh kiện cơ khí, động cơ thích hợp.
  2. Tính toán động học thuận và động học nghịch cho cánh tay robot bốn bậc tự do.
  3. Quy hoạch quỹ đạo chuyển động cho cánh tay robot.
  4. Nhúng dữ liệu quỹ đạo từ MATLAB sang mô hình Simscape và mô hình phần cứng thực tế.
  5. Nghiên cứu giao thức mạng CAN và ứng dụng vào việc truyền nhận dữ liệu của hệ thống.
  6. Nghiên cứu giải thuật điều khiển đồng bộ và triển khai lên hệ thống hai cánh tay robot.
  7. Lựa chọn các thiết bị điện phù hợp với hệ thống, đảm bảo tối ưu hóa chi phí.
  8. Thiết kế sơ đồ nguyên lý và thi công phần điện, tủ điều khiển.
  9. Lập trình điều khiển các module phần cứng theo yêu cầu kỹ thuật.
  10. Vận hành, kiểm chứng hoạt động của hệ thống điều khiển đồng bộ trên mô hình thực nghiệm.
  11. Thu thập dữ liệu thực nghiệm và đánh giá chất lượng hoạt động của hệ thống.

Đối tượng nghiên cứu là hệ hai cánh tay robot bốn bậc tự do hoạt động theo cơ chế đồng bộ. Phạm vi nghiên cứu được giới hạn ở bài toán động học robot (động học thuận, động học nghịch và quy hoạch quỹ đạo), không đi sâu vào mô hình động lực học phức tạp; robot hoạt động bám theo các quỹ đạo tín hiệu được lập trình trước; giải thuật điều khiển đồng bộ tập trung vào phương pháp tiếp cận chủ - tớ (Master-Slave Approach - MSA). Thông số ban đầu của mô hình thực nghiệm bao gồm: kích thước một robot là 200 x 200 x 550 mm (dài x rộng x cao), khối lượng một robot là 7,5 kg và tổng khối lượng hai robot là 15 kg.

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

Đề tài áp dụng các cơ sở lý thuyết và công cụ kỹ thuật chuẩn mực trong lĩnh vực điều khiển tự động và kỹ thuật robot:

  • Lý thuyết động học robot: Sử dụng quy tắc Denavit – Hartenberg (D-H) để gắn các hệ trục tọa độ lên các khâu và khớp quay, thiết lập bảng thông số D-H và xây dựng ma trận chuyển vị thuần nhất $^{i-1}_iT$ từ hệ tọa độ khâu $i$ về khâu $i-1$. Từ đó, nhân liên tiếp các ma trận chuyển vị để thu được ma trận động học thuận $^{0}_nT$, xác định vị trí và hướng của khâu tác động cuối. Bài toán động học nghịch được giải quyết bằng phương pháp kết hợp hình học và đại số để tính toán các biến khớp tương ứng với tọa độ không gian làm việc.
  • Quy hoạch quỹ đạo: Sử dụng đa thức bậc ba ($q(t) = a_0 + a_1t + a_2t^2 + a_3t^3$) để tạo tín hiệu vào tham chiếu mượt mà cho các khớp, thỏa mãn bốn điều kiện biên về vị trí và vận tốc tại thời điểm bắt đầu ($t_0$) và kết thúc ($t_f$), với giả thiết vận tốc tại điểm đầu và điểm cuối bằng 0.
  • Lý thuyết điều khiển đồng bộ: Khảo sát hai phương pháp đồng bộ chính gồm Synchronized Master Command Approach (SMCA) (các cơ cấu chấp hành nhận chung tín hiệu đặt nhưng không có hồi tiếp chéo) và Master-Slave Approach (MSA) (robot Slave nhận tín hiệu ngõ ra của robot Master làm tín hiệu điều khiển). Đồ án lựa chọn phương pháp MSA kết hợp với ma trận biến đổi hình học tuyến tính (Transformation Matrix) gồm các phép dịch chuyển (translation), xoay (rotation), tỉ lệ (scaling) và phản chiếu (reflection).
  • Lý thuyết truyền thông mạng: Ứng dụng giao thức truyền thông nối tiếp bất đồng bộ UART (Universal Asynchronous Receiver-Transmitter) và mạng CAN Bus 2.0 (Controller Area Network) theo tiêu chuẩn ISO 11898 tốc độ cao (CAN high-speed lên đến 1 Mbps), sử dụng tín hiệu điện áp vi sai giữa hai dây CAN_H và CAN_L cùng điện trở đầu cuối 120 $\Omega$ để truyền nhận dữ liệu điều khiển giữa các khối vi điều khiển.
  • Phương pháp nghiên cứu thực nghiệm: Thiết kế mô hình 3D trên SolidWorks 2019; chuyển đổi mô hình hình học sang MATLAB/Simulink thông qua công cụ Simscape Multibody; lập trình mô phỏng kiểm chứng chuyển động; nạp code nhúng xuống vi điều khiển STM32F407 thông qua thư viện Waijung Blockset; gia công khung vỏ bằng phương pháp in 3D; thiết kế mạch in PCB và đấu nối tủ điều khiển thực tế.

Nguồn dữ liệu của đề tài bao gồm các thông số kỹ thuật chuẩn của linh kiện (động cơ bước NEMA 17, driver TB6560, encoder LPD3806-400BM, vi điều khiển STM32F407, Arduino Pro mini LGT328P) và dữ liệu đo đạc thực nghiệm góc quay khớp, đáp ứng quỹ đạo thu thập qua phần mềm máy tính.

Thiết kế và triển khai

Hệ thống được thiết kế và triển khai đồng bộ giữa ba phân hệ chính: cơ khí, điện tử - điều khiển và mạng truyền thông.

Phân hệ / Khối chức năng Phần cứng / Công nghệ triển khai Thông số kỹ thuật / Đặc tính Chức năng trong hệ thống
Khung cơ khí Nhựa in 3D, thanh tyren, bạc đạn chà, khớp nối mềm 6-8 mm 5 cụm chính: Đế, Đế xoay, Link 1, Link 2, Link 3 Tạo kết cấu chuyển động 4 bậc tự do, chịu lực và định vị các khớp
Cơ cấu truyền động Puly GT2 20 răng (trục 5mm), Puly GT2 60 răng (trục 8mm), Puly đôi 60 răng, Dây đai GT2 Tỉ số truyền giảm tốc qua đai răng Truyền chuyển động từ động cơ đến các trục khớp một cách êm ái
Động cơ chấp hành Động cơ bước NEMA 17 size 42x42 mm và size 42x48 mm Góc bước 1.8 độ, hoạt động kết hợp driver TB6560 Dẫn động quay các trục khớp robot
Cảm biến hồi tiếp Rotary Optical Encoder LPD3806-400BM Độ phân giải 400 xung/vòng, ngõ ra NPN cực thu hở Đo góc quay thực tế của các khớp để kiểm chứng sai số
Khối điều khiển trung tâm Vi điều khiển STM32F407 (Master) Lõi ARM Cortex-M4, tích hợp ngoại vi CAN và UART Tính toán giải thuật động học, phát lệnh đồng bộ qua mạng CAN
Khối vi điều khiển phụ Arduino Pro mini LGT328P (Slave) Giao tiếp UART, xử lý tín hiệu xung/hướng Điều khiển cục bộ các driver động cơ và đọc encoder
Mạng truyền thông CAN Bus chuẩn 2.0 (CAN high-speed), module thu phát vi sai Tốc độ truyền tối đa 1 Mbps, định dạng khung chuẩn 11-bit ID Truyền dữ liệu trạng thái và góc khớp đồng bộ giữa Master và Slave
Phần mềm & Môi trường lập trình SolidWorks 2019, MATLAB/Simulink, Simscape Multibody, Waijung Blockset Mô hình hóa 3D, mô phỏng đa vật thể, sinh mã C nhúng tự động Thiết kế, kiểm chứng động học và nạp chương trình điều khiển

Hệ thống tủ điện điều khiển được thiết kế tách biệt giữa mạch động lực cấp nguồn cho driver TB6560 và mạch điều khiển xử lý tín hiệu nhỏ. Khối xử lý trung tâm được vẽ sơ đồ nguyên lý và gia công thành bảng mạch in PCB hoàn chỉnh, đảm bảo khả năng chống nhiễu và độ ổn định khi truyền tín hiệu điều khiển xung tốc độ cao.

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

Chương 1. Tổng quan về hệ thống

Trình bày tính cấp thiết của đề tài trong bối cảnh phát triển của robot công nghiệp và robot nhân hình. Tổng thuật các công trình nghiên cứu hệ hai cánh tay robot trong và ngoài nước (Yaskawa, DLR, Đại học Bách khoa Hà Nội, Đại học Sư phạm Kỹ thuật TP.HCM). Xác định rõ mục đích, 11 mục tiêu cụ thể, nội dung nghiên cứu 8 chương, đối tượng và phạm vi giới hạn của đề tài, phương pháp tiếp cận và các công cụ đánh giá hệ thống.

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

Trình bày định nghĩa tổng quan về robot và robot công nghiệp. Thiết lập cơ sở toán học cho bài toán động học thuận theo phương pháp Denavit - Hartenberg (D-H) với ma trận chuyển vị thuần nhất, bài toán động học nghịch bằng phương pháp hình học - đại số. Trình bày phương pháp quy hoạch quỹ đạo đa thức bậc ba. Cung cấp lý thuyết chi tiết về giao thức UART và mạng truyền thông CAN Bus 2.0 (cấu trúc Data Frame, Remote Frame, Error Frame, cơ chế vi sai CAN_H/CAN_L và chuẩn ISO 11898). Giới thiệu vai trò của các phần mềm SolidWorks và MATLAB/Simulink trong thiết kế và tính toán kỹ thuật.

Chương 3. Robot đồng bộ

Định nghĩa hệ hai cánh tay robot đồng bộ và phân tích các trường hợp ứng dụng thực tế. Phân tích chi tiết và so sánh hai giải thuật điều khiển đồng bộ kinh điển: phương pháp lệnh chủ đồng bộ (SMCA) và phương pháp chủ - tớ (MSA). Trình bày cơ sở toán học của ma trận chuyển đổi hình học (Transformation Matrix) bao gồm công thức và ý nghĩa của các phép biến đổi: tịnh tiến theo vector $(p_x, p_y)$, phản chiếu qua trục, tỉ lệ kích thước theo hệ số $(c_x, c_y)$ và xoay góc $\theta$ trong không gian 2D và 3D.

Chương 4. Thiết kế cánh tay robot bốn bậc tự do

Trình bày ý tưởng thiết kế kết cấu cơ khí 4 bậc tự do gồm 5 cụm cơ bản: đế cố định, đế xoay, thanh 1 (Link 1 gồm 11 và 12), thanh 2 (Link 2 gồm 21 và 22) và thanh 3 (Link 3). Trình bày chi tiết bản vẽ thiết kế 3D trên SolidWorks với các hình chiếu đứng, chiếu bằng, chiếu cạnh của từng link. Đưa ra giải pháp bố trí động cơ tại đế và đế xoay, kết hợp hệ thống truyền động đai răng GT2, thanh tyren và bạc đạn chà tại cụm đế xoay để giảm tải trọng quán tính cho các khâu chuyển động phía trên.

Chương 5. Tính toán và phương pháp điều khiển

Thiết lập bảng thông số D-H và giải phương trình động học thuận, động học nghịch cho robot 4-DOF. Khảo sát không gian làm việc đơn lẻ của một cánh tay và không gian làm việc chung khi hai cánh tay hoạt động đồng thời trong không gian 3D ($Oxyz$) và mặt phẳng chiếu ($Oxy$). Xây dựng mô hình mô phỏng Simscape Multibody kết nối với Simulink. Thực hiện mô phỏng quy hoạch quỹ đạo cho các trường hợp: đường thẳng (2 điểm), tam giác (3 điểm), chữ nhật (4 điểm) và hình tròn (4 điểm); phân tích đáp ứng góc khớp và moment lực. Thiết lập cấu hình truyền nhận dữ liệu 4 động cơ bước qua UART và cấu hình khối truyền nhận ngắt CAN Bus thông qua Waijung Blockset trên vi điều khiển STM32F407.

Chương 6. Thiết kế và thi công phần cứng

Hiện thực hóa mô hình cơ khí và hệ thống điện tử. Tính toán lực căng dây đai và lựa chọn các linh kiện cơ khí chuẩn: puly GT2 20 răng, puly GT2 60 răng, puly đôi 60 răng có bạc đạn, đai GT2, encoder quang LPD3806-400BM. Gia công các chi tiết khung vỏ bằng máy in 3D và lắp ráp hoàn chỉnh hai cánh tay robot. Thiết kế sơ đồ mạch động lực, sơ đồ khối tủ điện, bảng mạch nguyên lý và bản vẽ mạch in PCB cho khối xử lý trung tâm tích hợp STM32F407, Arduino Pro mini LGT328P, driver TB6560 và module thu phát CAN. Thi công lắp ráp hoàn thiện tủ điều khiển công nghiệp.

Chương 7. Thực nghiệm và kiểm chứng

Tiến hành chạy thực nghiệm trên mô hình phần cứng đã thi công. Kiểm chứng góc quay thực tế của từng khớp ($\theta_1, \theta_2, \theta_3, \theta_4$) thông qua tín hiệu đọc về từ encoder quang và so sánh với giá trị đặt. Kiểm chứng hoạt động đồng bộ của hệ hai cánh tay robot khi thực thi các quỹ đạo không gian, đặc biệt là quỹ đạo đường tròn, đánh giá sai số bám quỹ đạo và tính ổn định của giải thuật Master-Slave trên phần cứng thực tế.

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

Đánh giá tổng kết các kết quả đạt được đối chiếu với 11 mục tiêu đề ra ban đầu của đồ án. Nêu rõ những mặt hạn chế còn tồn tại về mặt động lực học và kết cấu cơ khí. Đề xuất các định hướng nghiên cứu và phát triển tiếp theo nhằm hoàn thiện hệ thống trong tương lai.

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

Đồ án đã hoàn thành toàn diện các mục tiêu đề ra từ khâu thiết kế lý thuyết, mô phỏng đến chế tạo và thử nghiệm mô hình thực tế với các kết quả cụ thể:

  • Chế tạo phần cứng hoàn chỉnh: Đã thi công thành công hệ hai cánh tay robot bốn bậc tự do với kích thước thực tế mỗi robot 200 x 200 x 550 mm, khối lượng 7,5 kg/robot (tổng khối lượng 15 kg), cùng một tủ điều khiển trung tâm được đấu nối theo tiêu chuẩn kỹ thuật.
  • Xây dựng bộ điều khiển và mạng truyền thông: Ứng dụng thành công vi điều khiển STM32F407 làm Master điều khiển thông qua thư viện Waijung Blockset trong môi trường MATLAB/Simulink; thiết lập mạng CAN Bus 2.0 tốc độ cao truyền nhận gói tin dữ liệu chuẩn xác giữa Master và các bộ điều khiển động cơ bước, đảm bảo thời gian thực và khả năng chống nhiễu tốt.
  • Mô phỏng và kiểm chứng quỹ đạo: Đã mô phỏng thành công trên Simscape Multibody và kiểm chứng thực nghiệm chuyển động của robot theo 4 dạng quỹ đạo tiêu chuẩn:
Dạng quỹ đạo kiểm chứng Số điểm định nghĩa quỹ đạo Tham số động học / Moment khớp Kết quả kiểm chứng trên mô hình
Đường thẳng 2 điểm mốc trong không gian Thu thập dữ liệu moment các khớp từ mô phỏng Robot Master và Slave bám sát quỹ đạo đặt, chuyển động êm
Hình tam giác 3 điểm mốc liên tiếp Tính toán đáp ứng vị trí và vận tốc theo đa thức bậc 3 Tín hiệu đáp ứng các khớp trùng khớp với tín hiệu đặt
Hình chữ nhật 4 điểm mốc khép kín Kiểm tra chuyển động chuyển hướng tại các góc Đáp ứng góc khớp chính xác, không bị trượt bước
Hình tròn 4 điểm định hình cung tròn Khảo sát quỹ đạo cong liên tục trong không gian 3D Robot thực hiện chuyển động đồng bộ mượt mà theo đường tròn

Về mặt đóng góp khoa học và kỹ thuật, đồ án đã kế thừa và phát triển công trình nghiên cứu hệ hai cánh tay robot 2 bậc tự do năm 2021 lên hệ thống 4 bậc tự do có cấu trúc cơ khí hoàn chỉnh, tích hợp hệ thống truyền động đai giảm tải trọng quán tính. Đề tài đã xây dựng một quy trình khép kín từ thiết kế 3D SolidWorks, mô phỏng động học Simscape Multibody, tự động sinh mã nhúng STM32F4 qua Waijung Blockset đến thi công phần cứng và điều khiển đồng bộ qua mạng CAN Bus công nghiệp.

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

Căn cứ trên các giới hạn nghiên cứu được công bố trong văn bản đồ án, hệ thống còn tồn tại một số điểm hạn chế:

  • Đề tài chỉ tập trung giải quyết bài toán động học robot (động học thuận, động học nghịch, quy hoạch quỹ đạo) mà chưa đi sâu phân tích mô hình động lực học toàn diện có tính đến ma sát khớp, quán tính phi tuyến và tải trọng thay đổi.
  • Hệ thống điều khiển hoạt động hoàn toàn dựa trên các quỹ đạo và tọa độ được lập trình sẵn, chưa tích hợp cảm biến lực ở khâu tác động cuối để điều khiển bù lực khi hai cánh tay cùng nâng hoặc thao tác trên một vật thể.
  • Khung cơ khí gia công bằng phương pháp in 3D kết hợp truyền động đai có độ cứng vững giới hạn, có thể xuất hiện sai số cơ khí nhỏ khi vận hành ở tốc độ cao hoặc mang tải nặng.

Các hướng nghiên cứu và phát triển tiếp theo được đề xuất bao gồm:

  • Nghiên cứu mô hình động lực học và ứng dụng các thuật toán điều khiển phi tuyến nâng cao (như điều khiển chế độ trượt thích ứng, mạng thần kinh hoặc điều khiển trở kháng/lực).
  • Tích hợp hệ thống thị giác máy (machine vision) để tự động nhận dạng, định vị và bám bắt đối tượng trong không gian làm việc.
  • Nâng cấp vật liệu gia công cơ khí bằng kim loại (nhôm, thép) để nâng cao độ bền, giảm độ rơ cơ khí và mở rộng cấu trúc lên 6 bậc tự do nhằm đáp ứng các tiêu chuẩn công nghiệp.

Giá trị tham khảo

Bản đồ án tốt nghiệp là tài liệu tham khảo có giá trị học thuật và ứng dụng thực tiễn đối với:

  • Sinh viên và học viên ngành Kỹ thuật Điều khiển & Tự động hóa, Cơ điện tử và Kỹ thuật Robot: Tài liệu cung cấp quy trình bài bản từ tính toán ma trận D-H, giải phương pháp động học nghịch kết hợp hình học - đại số, đến kỹ thuật quy hoạch quỹ đạo đa thức bậc ba.
  • Người nghiên cứu về mô phỏng động học đa vật thể: Phần chuyển đổi mô hình từ SolidWorks sang Simscape Multibody và nhúng mã điều khiển trực tiếp qua thư viện Waijung Blockset là một tài liệu hướng dẫn thực hành trực quan, giúp rút ngắn thời gian phát triển hệ thống điều khiển nhúng.
  • Kỹ sư thiết kế phần cứng và mạng truyền thông công nghiệp: Cung cấp thiết kế chi tiết về mạch in PCB xử lý trung tâm, sơ đồ đấu nối tủ điện điều khiển động cơ bước TB6560 và cách cấu hình mạng CAN Bus 2.0 chuẩn ISO 11898 chống nhiễu trong điều khiển robot.

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

1. Kích thước, khối lượng và cấu trúc bậc tự do của hệ robot trong đồ án được thiết kế như thế nào? Hệ thống gồm hai cánh tay robot, mỗi cánh tay có 4 bậc tự do (4-DOF). Kích thước thiết kế của một robot là 200 x 200 x 550 mm (dài x rộng x cao), khối lượng một cánh tay là 7,5 kg và tổng khối lượng hai cánh tay là 15 kg. Kết cấu gồm 5 cụm chính: Đế cố định, Đế xoay, Link 1, Link 2 và Link 3, được chế tạo bằng công nghệ in 3D kết hợp truyền động đai GT2 và thanh tyren.

2. Đồ án lựa chọn phương pháp điều khiển đồng bộ nào và ưu điểm so với phương pháp còn lại là gì? Đồ án khảo sát hai phương pháp là SMCA (Synchronized Master Command Approach) và MSA (Master-Slave Approach). Tác giả đã lựa chọn phương pháp MSA làm hướng điều khiển chính. Ưu điểm của MSA là robot Slave nhận trực tiếp tín hiệu ngõ ra của robot Master để làm tín hiệu điều khiển, kết hợp với các ma trận chuyển đổi hình học tuyến tính giúp duy trì sự phối hợp vị trí chính xác và linh hoạt giữa hai cánh tay.

3. Phần cứng điều khiển trung tâm và giao thức truyền thông trong hệ thống gồm những gì? Hệ thống sử dụng vi điều khiển STM32F407 (ARM Cortex-M4) làm Master trung tâm, được lập trình thông qua công cụ Waijung Blockset trên MATLAB/Simulink. Vi điều khiển phụ sử dụng Arduino Pro mini LGT328P. Mạng truyền thông giữa các khối sử dụng chuẩn CAN Bus 2.0 (tốc độ cao lên đến 1 Mbps, truyền tín hiệu vi sai qua 2 dây CAN_H và CAN_L) kết hợp với các cổng giao tiếp UART nối tiếp.

4. Quy hoạch quỹ đạo của robot được tính toán bằng phương pháp nào và đã thử nghiệm những dạng quỹ đạo nào? Quỹ đạo của robot được quy hoạch bằng phương pháp đa thức bậc ba với 4 điều kiện biên về vị trí và vận tốc (vận tốc đầu và cuối bằng 0). Hệ thống đã được kiểm chứng mô phỏng và thực nghiệm qua 4 dạng quỹ đạo: đường thẳng (nối 2 điểm), hình tam giác (nối 3 điểm), hình chữ nhật (nối 4 điểm) và hình tròn không gian (nối 4 điểm).

5. Đồ án sử dụng loại cảm biến và cơ cấu chấp hành nào cho các khớp robot? Cơ cấu chấp hành sử dụng động cơ bước NEMA 17 (kích thước size 42x42 mm và size 42x48 mm) điều khiển qua các mạch driver TB6560. Cảm biến phản hồi vị trí góc khớp là Encoder quang quay LPD3806-400BM ngõ ra NPN cực thu hở với độ phân giải 400 xung/vòng.

Kết luận

Đồ án tốt nghiệp "Thiết kế mô hình và điều khiển đồng bộ chủ tớ cho hệ hai cánh tay robot bốn bậc tự do" đã giải quyết trọn vẹn bài toán từ cơ sở lý thuyết động học, quy hoạch quỹ đạo đến thi công hoàn thiện mô hình phần cứng và tủ điều khiển thực tế. Việc tích hợp thành công mô phỏng Simscape Multibody, lập trình nhúng STM32F407 qua Waijung Blockset và truyền thông mạng CAN Bus 2.0 tạo nên một hệ thống điều khiển đồng bộ ổn định và chính xác. Đây là công trình kỹ thuật có hàm lượng thực nghiệm cao, đóng vai trò là tài liệu tham khảo hữu ích cho các nghiên cứu chuyên sâu về robot song song và tự động hóa công nghiệp.