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

Trong tiến trình phát triển của sản xuất công nghiệp hiện đại, việc ứng dụng các phương tiện tự động hóa nhằm thay thế sức lao động của con người là xu hướng tất yếu. Các hệ thống robot công nghiệp (Industrial Robot - IR) đóng vai trò then chốt trong việc nâng cao năng suất, đảm bảo chất lượng, tính đồng đều của sản phẩm và mang lại hiệu quả kinh tế cao. Robot công nghiệp có khả năng làm việc liên tục trong môi trường độc hại, ô nhiễm, nguy hiểm, đồng thời thực hiện các thao tác đòi hỏi độ chính xác cao và sự tỉ mỉ mà con người khó duy trì trong thời gian dài do mệt mỏi hoặc căng thẳng.

Một trong những nhu cầu thực tế trong công nghiệp chế tạo là thao tác viết chữ, khắc chữ và tạo hình bề mặt trên các chi tiết, vật liệu. Quá trình gia công này đòi hỏi chuyển động đều đặn, chính xác và linh hoạt trong không gian ba chiều. Bên cạnh đó, trong môi trường giáo dục kỹ thuật, sinh viên ngành cơ khí và cơ điện tử thường chủ yếu tiếp cận mô hình cánh tay robot qua mô phỏng lý thuyết trên máy tính, thiếu điều kiện tiếp xúc với các mô hình phần cứng thực nghiệm đa bậc tự do.

Xuất phát từ các yêu cầu thực tiễn và đào tạo trên, đề tài "Thiết kế, chế tạo và điều khiển cánh tay Robot 6 bậc tự do" được thực hiện nhằm giải quyết các nhiệm vụ và mục tiêu nghiên cứu cụ thể:

  1. Tìm hiểu, tổng quan về cấu trúc, phân loại và nguyên lý hoạt động của robot công nghiệp.
  2. Tính toán thiết kế và chế tạo phần cứng cơ khí cho cánh tay robot chuỗi hở có 6 bậc tự do (6 DOF).
  3. Thiết kế, thi công hệ thống mạch điện tử điều khiển phân tầng cho 6 khớp của cánh tay robot.
  4. Xây dựng thuật toán điều khiển chuyển động (động học và giải thuật PID điều khiển vị trí vòng kín).
  5. Lập trình giao diện người dùng trên máy tính để giám sát, điều khiển vị trí và vận tốc của từng khớp robot.
  • Đối tượng nghiên cứu: Mô hình thực nghiệm cánh tay robot 6 bậc tự do sử dụng hệ truyền động động cơ DC Servo và bộ truyền đai răng.
  • Phạm vi nghiên cứu: Thiết kế, chế tạo phần cứng cơ khí, mạch điện tử và thuật toán điều khiển trong khuôn khổ đồ án tốt nghiệp ngành Công nghệ Kỹ thuật Cơ điện tử tại Trường Đại học Sư phạm Kỹ thuật TP. Hồ Chí Minh, định hướng ứng dụng trong thực hành giảng dạy và gia công khắc chữ công nghiệp.

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

Đề tài kết hợp giữa nghiên cứu lý thuyết tính toán kỹ thuật và phương pháp chế tạo thực nghiệm hệ thống cơ điện tử:

  • Lý thuyết robot học và động học: Sử dụng phương pháp Denavit-Hartenberg (DH) để gắn các hệ trục tọa độ lên từng khâu, xây dựng bảng thông số DH và thiết lập các ma trận biến đổi thuần nhất biểu diễn mối quan hệ không gian giữa khâu công tác cuối và hệ tọa độ gốc.
  • Lý thuyết tính toán cơ khí và truyền động: Vận dụng nguyên lý cơ học máy để phân tích tải trọng tĩnh và động, tính toán mô-men xoắn cực đại phát sinh trên các trục khớp khi cánh tay duỗi thẳng toàn phần; áp dụng các công thức tính toán tiêu chuẩn trong thiết kế hệ dẫn động cơ khí để chọn mô-đun, bước đai, bề rộng đai răng (loại đai S5M) và lựa chọn ổ bi đỡ, ổ bi côn chịu lực.
  • Lý thuyết điều khiển tự động: Áp dụng bộ điều khiển vi tích phân tỉ lệ (PID) cho hệ thống điều khiển vị trí vòng kín từng khớp; sử dụng phản hồi vị trí từ encoder góc quay qua chế độ đọc giải mã xung nhân 4 nhằm tăng độ phân giải đo lường.
  • Phương pháp thực nghiệm và thu thập dữ liệu: Thiết kế mô hình 3D trên phần mềm chuyên ngành, gia công các chi tiết cơ khí bằng kim loại (inox, đồng, thép), thiết kế và ủi/rửa mạch in PCB (Printed Circuit Board), nạp chương trình vi điều khiển, và ghi nhận dữ liệu đáp ứng thực tế qua giao thức truyền thông nối tiếp UART về máy tính.
  • Nguồn dữ liệu: Các bảng tra thông số tiêu chuẩn cơ khí (sổ tay thiết kế hệ dẫn động cơ khí), datasheet linh kiện bán dẫn (dsPIC30F4011, PIC18F4431, MOSFET, Opto 6N137, PC817) và dữ liệu đo đạc thực nghiệm từ 6 bộ encoder của động cơ servo.

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

Chương 1: Tổng quan về Robot công nghiệp

Chương này tổng thuật lịch sử phát triển của robot công nghiệp từ thiết bị Versatran đầu tiên của công ty AMF (Mỹ) vào đầu thập niên 1960, qua ba thế hệ robot (từ điều khiển chu trình cứng, chương trình mềm đến thế hệ nhận biết thông tin môi trường). Tác giả phân tích sơ đồ cấu trúc chức năng tổng quát của một robot công nghiệp gồm: hệ thống điều khiển, hệ thống chấp hành (phần truyền chuyển động và phần chịu lực), hệ thống cảm biến (nội tín hiệu và ngoại tín hiệu) và thiết bị giao tiếp với người vận hành. Đồng thời, chương 1 định nghĩa robot 6 bậc tự do là hệ chuỗi động có khả năng tạo chuyển động linh hoạt trong không gian 3 chiều và tổng kết các ứng dụng trong giáo dục, sản xuất công nghiệp và an ninh quốc phòng.

Chương 2: Phân tích và lựa chọn cấu trúc

Nội dung chương tập trung so sánh các dạng cấu trúc hình học của tay máy (tọa độ Đề-các, tọa độ trụ, tọa độ cầu, tọa độ góc, SCARA và PUMA) cũng như các hệ truyền động phổ biến (truyền động điện, thủy lực, khí nén). Tác giả lựa chọn mô hình robot 6 bậc tự do dạng tọa độ góc với tất cả các khớp là khớp quay (Revolute joints), sử dụng hệ truyền động động cơ điện một chiều (DC Servo) công suất 17W kết hợp bộ truyền đai răng để truyền động êm, không gây ồn, chịu quá tải tốt và dễ điều khiển. Mô hình 3D sơ bộ của toàn bộ hệ thống được xây dựng làm cơ sở gia công chế tạo.

Chương 3: Thiết kế cơ khí

Tác giả phân tích chi tiết kết cấu của từng bộ phận: cụm đế cố định, đế bắt động cơ khớp 1, gá động cơ, ổ đỡ UCP80, vòng đế quay, tấm quay chịu lực, và các trục truyền động khớp 1 (bằng thép rỗng $\varnothing 36/\varnothing 40\text{ mm}$ để luồn dây điện), trục khớp 2 (bằng inox dài $302\text{ mm}$ chống võng và chống gỉ), trục khớp 3 (bằng đồng).

Chương 3 trình bày các phép tính toán mô-men tải trọng tĩnh cực đại:

  • Tại khớp số 2: Mô-men uốn do trọng lượng bản thân các khâu khi duỗi thẳng đạt $M_{p2} = 12.176,86\text{ N.mm}$. Sử dụng động cơ 17W kèm hộp giảm tốc $1:180$, qua bộ truyền đai 2 cấp tỉ số truyền $U_2 = 11,25$, mô-men tạo ra trên trục công tác đạt $29.260\text{ N.mm}$, cho phép nâng thêm một lực tải dư $P = 37\text{ N}$ ở đầu cánh tay (tương đương cánh tay đòn $450\text{ mm}$).
  • Tại khớp số 3: Mô-men do trọng lượng khâu là $M_{p3} = 2.141,7\text{ N.mm}$, mô-men trục công tác đạt $19.926\text{ N.mm}$.
  • Tính toán bộ truyền đai: Xác định mô-đun ăn khớp, bước đai $P = 5\text{ mm}$ (loại đai S5M), tính toán bề rộng đai lý thuyết $b = 8\text{ mm}$ và chọn $b = 20\text{ mm}$ cho toàn bộ các khớp để tăng độ bền tĩnh và độ bền mỏi.
  • Xác định hệ thống ổ lăn (ổ bi côn $d=40\text{ mm}$ cho trục 1; ổ bi đỡ cho các trục còn lại) và biên độ giới hạn góc quay vật lý cho cả 6 khớp.

Chương 4: Thiết kế mạch điều khiển

Chương 4 mô tả thiết kế kiến trúc phần cứng điều khiển phân tán gồm vi điều khiển Master (dsPIC30F4011) và 6 vi điều khiển Slave (PIC18F4431). dsPIC30F4011 đảm nhận giao tiếp với máy tính qua cổng UART1 và điều phối dữ liệu xuống 6 vi điều khiển PIC18F4431 qua cổng UART2 với chu kỳ truyền nhận $20\text{ ms}$. Mỗi chip PIC18F4431 chịu trách nhiệm thực thi thuật toán PID độc lập cho một khớp, nhận tín hiệu xung phản hồi từ encoder qua mạch giải mã phần cứng và xuất xung PWM cùng tín hiệu hướng DIR điều khiển mạch công suất cầu H lái động cơ DC Servo. Chương này cung cấp đầy đủ sơ đồ nguyên lý mạch nguồn ổn áp (LM2576-5V, LM1117-3.3V), mạch cách ly quang tốc độ cao (Opto 6N137 và PC817), mạch relay đóng cắt bảo vệ và mạch in cầu H.

Chương 5: Giải thuật điều khiển

Trình bày phương pháp gắn hệ trục tọa độ Denavit-Hartenberg cho 6 khâu của tay máy, lập bảng thông số DH và xác định các ma trận chuyển đổi thuần nhất $A_i^{i-1}$ ($i = 1 \dots 6$). Phép nhân chuỗi ma trận $T_6^0 = A_1^0 A_2^1 A_3^2 A_4^3 A_5^4 A_6^5$ cho phép xác định tọa độ và hướng của khâu tác động cuối theo các biến khớp. Đồng thời, chương 5 phân tích lý thuyết thiết kế bộ điều khiển PID vị trí, giải thích tác động của các khâu tỉ lệ ($K_p$), tích phân ($K_i$) và vi phân ($K_d$) đối với thời gian đáp ứng, độ vọt lố và sai số xác lập của hệ thống.

Chương 6: Giao diện lập trình và kết quả

Mô tả phần mềm giao diện điều khiển trên máy tính với các tab chức năng: Control Position (điều khiển vị trí từng khớp theo độ), Control Speed (điều khiển vận tốc), Input Data và Input Coordinate. Tác giả trình bày hình ảnh mô hình robot thực nghiệm hoàn thiện, hệ thống tủ mạch điều khiển, tiến hành các bài kiểm tra thực nghiệm điều khiển vị trí góc quay tại các mốc $30^\circ$ và $60^\circ$ cho cả 6 khớp, ghi nhận dữ liệu đáp ứng và vẽ biểu đồ sai số vị trí.

Thiết kế và triển khai

Hệ thống cánh tay robot 6 bậc tự do được triển khai đồng bộ qua ba phân hệ chính: kết cấu cơ khí truyền động, phần cứng điện tử phân tầng và phần mềm điều khiển.

1. Thông số kết cấu cơ khí và tỉ số truyền động

Hệ thống sử dụng các động cơ DC Servo tích hợp hộp giảm tốc và đai răng để truyền động cho 6 bậc tự do:

Khớp số Loại động cơ Tỉ số truyền đai ($U$) Thông số bánh đai răng ($z$) Giới hạn góc quay ($^\circ$) Số xung Encoder/vòng khớp (x4)
Khớp 1 DC Servo 24V - 17W $1 : 3,75$ $z_1 = 16, z_2 = 60$ ($P=5\text{ mm}$) $0^\circ \to +180^\circ$ $64.800$
Khớp 2 DC Servo 24V - 17W $1 : 11,25$ (2 cấp) $z_1 = 16, z_2 = 60; z_3 = 20, z_4 = 60$ $0^\circ \to +100^\circ$ $97.200$
Khớp 3 DC Servo 24V - 17W $1 : 7,5$ (2 cấp) $z_1 = 16, z_2 = 60; z_3 = 20, z_4 = 40$ $0^\circ \to +137^\circ$ $64.800$
Khớp 4 DC Servo 24V - 17W $1 : 1$ $z_1 = 32, z_2 = 32$ ($m=0,6$) $0^\circ \to +130^\circ$ $8.640$
Khớp 5 DC Servo 24V - 17W $1 : 2$ $z_1 = 16, z_2 = 36$ ($P=5\text{ mm}$) $0^\circ \to +94^\circ$ $17.280$
Khớp 6 DC Servo GA25 12V $1 : 34$ (trực tiếp) Trục động cơ nối trực tiếp $0^\circ \to +360^\circ$ $45.424$

2. Kiến trúc phần cứng và sơ đồ ghép nối điện tử

Hệ thống điều khiển điện tử hoạt động theo mô hình Master - Slave phân tán:

  • Khối Master (dsPIC30F4011): Sử dụng thạch anh ngoài, giao tiếp với máy tính qua bộ UART1, nhận chuỗi dữ liệu đặt góc, phân tích cú pháp và truyền xuống các mạch Slave qua bộ UART2; điều khiển mạch Relay đóng/ngắt nguồn công suất cho hệ thống.
  • Khối Slave (6 mạch PIC18F4431): Mỗi vi điều khiển PIC18F4431 xử lý riêng một trục động cơ, sử dụng bộ Motion Feedback Module tích hợp để đọc tín hiệu encoder 2 kênh pha A-B ở chế độ x4, thực hiện thuật toán PID chu kỳ và xuất tín hiệu điều khiển động cơ.
  • Khối cách ly và công suất: Sử dụng IC cách ly quang 6N137 cho các đường xung tốc độ cao và PC817 cho các đường tín hiệu điều khiển chiều, phối hợp với IC logic 74HC04, 74HC00 để kích tầng công suất MOSFET của 6 mạch cầu H.

3. Giao thức truyền dữ liệu

Dữ liệu điều khiển giữa máy tính, Master và 6 Slave được đóng gói theo các chuỗi bản tin định dạng chuẩn:

  • Chuỗi từ Máy tính $\to$ Master: xxxAxxxBxxxCxxxDxxxExxxF (trong đó xxx là giá trị góc quay của từng khớp; A, B, C, D, E, F là ký tự định danh kênh từ khớp 1 đến khớp 6; ký tự y, z dùng để đóng nguồn relay và Y, Z dùng để ngắt nguồn).
  • Chuỗi từ Master $\to$ 6 Slave: xxxPxxxQxxxRxxxSxxxTxxxUV (trong đó P, Q, R, S, T, U là các ký tự địa chỉ của từng PIC Slave, U là tín hiệu cho phép tính toán, và ký tự kết thúc V kích hoạt đồng loạt giải thuật PID trên toàn bộ 6 khớp). Chu kỳ xử lý toàn chuỗi truyền nhận mất $20\text{ ms}$.

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

1. Kết quả thực nghiệm

Đề tài đã hoàn thành chế tạo mô hình thực tế và thử nghiệm vận hành hệ thống với các chỉ số kỹ thuật chính:

  • Chế tạo thành công cánh tay robot 6 bậc tự do bằng kim loại với đầy đủ 6 khớp quay, lắp đặt động cơ servo, cơ cấu đai răng, hệ thống công tắc hành trình giới hạn cơ khí an toàn và hệ thống luồn dây cáp ngầm bên trong trục rỗng khớp 1.
  • Mạch điều khiển phân tầng Master - Slave hoạt động ổn định, cách ly chống nhiễu hoàn toàn giữa khối điều khiển số và khối công suất cầu H.
  • Giao diện phần mềm trên máy tính cho phép thiết lập phiên làm việc (New Session), cài đặt tọa độ, đặt góc quay độc lập cho từng khớp và kiểm soát vận tốc.
  • Kết quả thử nghiệm đáp ứng vị trí của các khớp tại các góc đặt thử nghiệm $30^\circ$ và $60^\circ$ cho thấy các khớp bám sát giá trị đặt với độ ổn định cao sau giai đoạn quá độ.

2. Đóng góp của công trình

  • Về mặt kỹ thuật: Đề xuất và hiện thực hóa thành công giải pháp điều khiển phân tán Master - Slave cho robot 6 bậc tự do sử dụng dòng vi điều khiển chuyên dụng cho điều khiển động cơ (PIC18F4431 và dsPIC30F4011), giảm tải tính toán cho bộ điều khiển trung tâm và tăng tính mô-đun hóa của hệ thống.
  • Về mặt giáo dục và đào tạo: Cung cấp một bộ giáo cụ trực quan hoàn chỉnh từ bản vẽ thiết kế cơ khí, sơ đồ mạch in đến chương trình phần mềm, phục vụ trực tiếp cho việc giảng dạy và thực hành các môn học Cơ sở Robot, Điều khiển tự động và Cơ điện tử tại trường đại học.

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

  • Hạn chế:
    • Do gia công cơ khí thủ công và sử dụng bộ truyền đai răng kết hợp hộp giảm tốc có sẵn, hệ thống vẫn tồn tại độ rơ cơ học nhất định, ảnh hưởng đến độ chính xác lặp lại tại khâu tác động cuối.
    • Đề tài mới tập trung kiểm nghiệm bài toán động học thuận và điều khiển vị trí độc lập từng khớp; bài toán động học nghịch và nội suy quỹ đạo liên tục trong không gian 3 chiều (đường thẳng, đường cong phức tạp) chưa được tích hợp hoàn chỉnh trên giao diện máy tính.
  • Hướng nghiên cứu tiếp:
    • Bổ sung thuật toán giải bài toán động học ngược (Inverse Kinematics) trực tiếp trên phần mềm điều khiển để người dùng có thể nhập tọa độ không gian $(X, Y, Z, Roll, Pitch, Yaw)$ của điểm công tác.
    • Tích hợp cơ cấu đầu công tác chuyên dụng (đầu khắc laser hoặc đầu kẹp) kết hợp hệ thống thị giác máy tính (Camera) để nhận diện biên dạng chữ và tự động sinh quỹ đạo khắc chữ trên sản phẩm.
    • Tối ưu hóa giải thuật điều khiển (như áp dụng PID thích nghi hoặc điều khiển mờ) nhằm giảm thiểu thời gian quá độ và triệt tiêu độ vọt lố khi cánh tay mang tải thay đổi.

Giá trị tham khảo

Tài liệu đồ án tốt nghiệp này mang lại giá trị tham khảo hữu ích cho:

  • Sinh viên ngành Kỹ thuật Cơ điện tử, Robot học và Tự động hóa: Là tài liệu mẫu về quy trình thiết kế hoàn chỉnh một hệ thống robot nhiều bậc tự do, từ khâu tính toán sức bền, phân bố mô-men lực, chọn động cơ, tính chọn bộ truyền đai răng đến thiết kế mạch in.
  • Các nhóm nghiên cứu về điều khiển truyền động: Cung cấp tài liệu tham khảo thực tế về phương pháp ghép nối truyền thông UART Master - Slave và cấu hình khối phần cứng giải mã encoder trên vi điều khiển họ Microchip PIC/dsPIC.
  • Phần đáng tham khảo nhất: Phương pháp tính toán mô-men xoắn tại các khớp chịu tải nặng (Chương 3) và sơ đồ nguyên lý ghép nối mạch cách ly quang - cầu H MOSFET (Chương 4).

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

1. Cấu trúc phần cứng điều khiển của cánh tay robot này được phân cấp như thế nào?

Hệ thống sử dụng cấu trúc phân tầng Master - Slave. Máy tính đóng vai trò là giao diện cấp cao gửi lệnh điều khiển. Khối Master sử dụng vi điều khiển dsPIC30F4011 làm nhiệm vụ nhận dữ liệu từ máy tính qua UART1, đóng ngắt relay nguồn hệ thống và phân phối dữ liệu góc quay xuống 6 vi điều khiển Slave qua UART2. Khối Slave gồm 6 chip PIC18F4431, mỗi chip độc lập xử lý thuật toán PID, đọc tín hiệu encoder x4 và xuất xung PWM/DIR điều khiển một mạch cầu H riêng biệt cho từng động cơ.

2. Tác giả đã tính toán mô-men và khả năng nâng tải tại khớp số 2 như thế nào?

Tại vị trí nguy hiểm nhất khi cánh tay duỗi thẳng hoàn toàn (cánh tay đòn dài nhất), tổng mô-men tĩnh do trọng lượng các khâu gây ra tại khớp số 2 là $M_{p2} = 12.176,86\text{ N.mm}$. Động cơ 17W (vận tốc $9.000\text{ vòng/phút}$, qua hộp giảm tốc $1:180$ và bộ truyền đai 2 cấp tỉ số truyền $11,25$, hiệu suất $\eta = 0,85$) tạo ra mô-men trên trục công tác đạt $29.260\text{ N.mm}$. Do mô-men trục lớn hơn mô-men do trọng lượng bản thân, cánh tay có khả năng nâng thêm một lực tải dư ở đầu khâu là $P = 37\text{ N}$ với cánh tay đòn $450\text{ mm}$.

3. Chế độ đọc encoder nhân 4 được tính toán để xác định độ phân giải góc quay ra sao?

Tổng số xung phản hồi trên một vòng quay của khớp được tính bằng công thức: Số xung/vòng = (Số xung encoder) $\times$ (Tỉ số truyền hộp giảm tốc) $\times$ (Tỉ số truyền cơ cấu đai) $\times$ 4. Ví dụ tại khớp 1, với động cơ servo có encoder 12 xung/vòng, hộp giảm tốc $1:180$, tỉ số truyền đai $3,75$ và đọc nhân 4, tổng số xung trên một vòng quay hoàn chỉnh ($360^\circ$) đạt $64.800\text{ xung}$, tương ứng với $180\text{ xung/độ}$.

4. Giao thức truyền dữ liệu giữa Master và các vi điều khiển Slave được định dạng như thế nào?

Dữ liệu từ Master gửi xuống 6 Slave qua UART2 có cấu trúc chuỗi ký tự: xxxPxxxQxxxRxxxSxxxTxxxUV. Trong đó, xxx là các giá trị góc quay tương ứng cho 6 khớp; các ký tự P, Q, R, S, T, U định danh vị trí dữ liệu cho từng chip PIC18F4431 từ 1 đến 6; ký tự U đóng vai trò là tín hiệu cho phép (enable), và ký tự V ở cuối chuỗi là lệnh kích hoạt đồng loạt 6 vi điều khiển Slave bắt đầu xuất xung PWM và thực thi thuật toán PID điều khiển động cơ.

Kết luận

Đồ án "Thiết kế, chế tạo và điều khiển cánh tay Robot 6 bậc tự do" đã hoàn thành việc nghiên cứu, tính toán cơ khí, chế tạo phần cứng và xây dựng hệ thống điều khiển phân tán Master - Slave cho mô hình cánh tay robot 6 DOF. Công trình đã chứng minh tính khả thi của giải pháp điều khiển vòng kín từng khớp bằng thuật toán PID trên vi điều khiển PIC18F4431 kết hợp với bộ điều phối trung tâm dsPIC30F4011 và giao diện máy tính. Mặc dù còn hạn chế về độ rơ cơ học và việc tự động hóa bài toán động học ngược, kết quả của đồ án cung cấp một nền tảng thực nghiệm giá trị, phục vụ hiệu quả cho công tác giảng dạy kỹ thuật và định hướng ứng dụng trong gia công sản xuất công nghiệp.