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

Trong xu thế công nghiệp hóa, hiện đại hóa và phát triển các dây chuyền sản xuất tự động có tính linh hoạt cao, việc ứng dụng tay máy robot công nghiệp vào các công đoạn sản xuất đóng vai trò thiết yếu. Robot thực hiện thao tác bốc xếp và gắp đặt vật thể tự động giúp đảm bảo độ chính xác vị trí, duy trì chu trình làm việc liên tục, nâng cao năng suất và ổn định chất lượng sản phẩm. Đề tài "Thiết kế và tính toán động học cho robot thực hiện nhiệm vụ theo yêu cầu công nghệ" được thực hiện nhằm giải quyết bài toán ứng dụng robot công nghiệp trong dây chuyền vận chuyển phôi/kiện hàng giữa hai vị trí cố định theo yêu cầu công nghệ chuyên biệt.

Theo văn bản đồ án, các mục tiêu và nhiệm vụ nghiên cứu được xác định bao gồm 5 nội dung chính:

  1. Tìm hiểu tổng quát quá trình phát triển và ứng dụng của robot trong công nghiệp.
  2. Thiết kế và phân tích động học robot (bao gồm bài toán động học thuận và bài toán động học ngược).
  3. Xây dựng và tính toán quỹ đạo chuyển động cho robot trong không gian khớp.
  4. Nghiên cứu cơ sở lý thuyết điều khiển tự động robot công nghiệp.
  5. Xây dựng mô hình hình học và mô phỏng chuyển động của robot trên các phần mềm chuyên ngành.

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

  • Đối tượng nghiên cứu: Cấu trúc động học và quy luật chuyển động của robot công nghiệp 6 bậc tự do chuỗi hở (cụ thể là dòng robot công nghiệp ABB IRB 1200-5/0.9).
  • Phạm vi không gian: Không gian làm việc ba chiều phục vụ vận chuyển kiện hàng giữa hai vị trí A và B với khoảng cách hai vị trí là $1655\text{ mm}$ (bán kính thao tác tối thiểu $827{,}5\text{ mm}$ tính từ điểm đặt trung gian), độ cao chênh lệch giữa vị trí ban đầu và vị trí kết thúc là $304\text{ mm}$.
  • Yêu cầu công nghệ ràng buộc: Vận chuyển khối hàng từ vị trí A sang vị trí B đồng thời bảo đảm giữ nguyên hướng của mặt chữ "TNUT" về cùng một phía trong suốt hành trình.

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

Đề tài sử dụng hệ thống lý thuyết động học tay máy nhiều khâu và các công cụ toán học, tin học kỹ thuật sau:

  • Khung lý thuyết động học robot:

    • Phương pháp Denavit - Hartenberg (D-H): Thiết lập các hệ trục tọa độ cục bộ gắn liền với từng khâu của tay máy để mô tả cấu trúc hình học thông qua 4 thông số: góc quay khớp $\theta_i$, khoảng cách dịch chuyển dọc trục $d_i$, chiều dài khâu $a_i$, và góc xoắn giữa các trục $\alpha_i$.
    • Ma trận chuyển đổi thuần nhất $4 \times 4$ ($A_{n-1}^n$): Xác định quan hệ vị trí và hướng tương đối giữa hai khâu kế tiếp.
    • Bài toán động học thuận: Xác định vị trí và hướng của khâu tác động cuối (bàn tay kẹp/đầu hút) từ giá trị cho trước của các biến khớp $q_i(t)$.
    • Bài toán động học ngược: Xác định các biến khớp $q_i(t)$ ($i = 1 \dots 6$) tương ứng với vị trí và hướng tọa độ mong muốn của khâu chấp hành cuối.
    • Lý thuyết nội suy quỹ đạo trong không gian khớp: Xây dựng hàm đa thức bậc 3 ($u(t) = a_1 t^3 + b_1 t^2 + c_1 t + d_1$) kết hợp điều kiện vận tốc trơn tại các điểm chốt chuyển tiếp.

  • Phương pháp nghiên cứu:

    • Phương pháp giải tích và đại số ma trận: Xây dựng ma trận biến đổi thuần nhất tổng quát $A_0^6 = A_0^1 \cdot A_1^2 \cdot A_2^3 \cdot A_3^4 \cdot A_4^5 \cdot A_5^6$ bằng công cụ tính toán ma trận trên MATLAB.
    • Phương pháp số tối ưu hóa phi tuyến (GRG Nonlinear): Sử dụng thuật toán Generalized Reduced Gradient (Gradient rút gọn tổng quát) thông qua công cụ Solver trên Microsoft Excel để giải hệ 6 phương trình phi tuyến xác định nghiệm động học ngược.
    • Phương pháp lập trình và mô phỏng đồ họa: Sử dụng MATLAB để lập trình giải thuật tính toán hệ số đa thức, vẽ đồ thị biến thiên của các biến khớp theo thời gian, kết hợp các phần mềm CAD/CAE (AutoCAD, Autodesk Inventor, SolidWorks) để dựng mô hình 3D và xuất video mô phỏng chuyển động.

  • Nguồn dữ liệu:

    • Dữ liệu thông số kỹ thuật, cấu trúc hình học và kích thước các khâu của robot công nghiệp ABB IRB 1200-5/0.9 do hãng ABB công bố.
    • Các thông số công nghệ đầu vào từ bài toán thực tế đặt ra tại xưởng/dây chuyền thực nghiệm.

Thiết kế và tính toán động học robot

Hệ thống kỹ thuật được thiết kế dựa trên tay máy nối tiếp 6 bậc tự do IRB 1200-5/0.9 của hãng ABB. Các thông số kích thước cơ bản trích xuất từ văn bản gồm:

  • Chiều cao bệ đến khớp 2: $d_1 = 399\text{ mm}$
  • Chiều dài khâu cánh tay: $a_2 = 448\text{ mm}$
  • Độ lệch khâu 3: $a_3 = 42\text{ mm}$
  • Chiều dài cẳng tay: $d_4 = 451\text{ mm}$
  • Chiều dài từ khớp 5 đến điểm tác động cuối: $d_6 = 82\text{ mm}$
  • Tầm với cực đại của robot: $905\text{ mm}$

Bảng thông số động học Denavit - Hartenberg (D-H) của robot IRB 1200-5/0.9 được thiết lập như sau:

Khâu ($i$) Góc khớp $\theta_i$ (rad) Độ dịch chuyển $d_i$ (mm) Chiều dài khâu $a_i$ (mm) Góc xoắn $\alpha_i$ (rad)
1 $\theta_1$ $399$ $0$ $\pi/2$
2 $\theta_2$ $0$ $448$ $0$
3 $\theta_3$ $0$ $42$ $\pi/2$
4 $\theta_4$ $451$ $0$ $-\pi/2$
5 $\theta_5$ $0$ $0$ $\pi/2$
6 $\theta_6$ $82$ $0$ $0$

Ma trận chuyển đổi thuần nhất tổng quát từ hệ tọa độ gốc $O_0$ sang hệ tọa độ khâu cuối $O_6$ có dạng ma trận $4 \times 4$:

$$A_0^6 = \begin{bmatrix} n_x & s_x & a_x & P_x \ n_y & s_y & a_y & P_y \ n_z & s_z & a_z & P_z \ 0 & 0 & 0 & 1 \end{bmatrix}$$

Để giải bài toán động học ngược, tác giả thiết lập hàm mục tiêu tối thiểu hóa sai số bình phương giữa tọa độ thực tế mong muốn và tọa độ tính toán theo ma trận $A_0^6$:

$$\min L = \sum_{j=1}^6 L_j = (P_x - a_{14})^2 + (P_y - a_{24})^2 + (P_z - a_{34})^2 + (S_y - a_{22})^2 + (A_y - a_{23})^2 + (A_z - a_{33})^2$$

Hàm mục tiêu được giải trên Excel Solver với thuật toán GRG Nonlinear, tìm ra 6 biến khớp $q_1, q_2, q_3, q_4, q_5, q_6$ cho từng vị trí làm việc.

Trong khâu thiết kế quỹ đạo, đường chuyển động trong không gian khớp qua các điểm chuyển tiếp được nội suy bằng hàm đa thức bậc 3. Vận tốc tại các điểm trung gian được xác định thông qua hệ số góc $k_i = \frac{q_{i+1} - q_i}{t_{i+1} - t_i}$. Hệ số góc chuyển tiếp $K_{ci}$ được tính theo quy tắc:

  • Nếu $\text{sign}(k_i) \neq \text{sign}(k_{i+1})$ thì $K_{ci} = 0$.
  • Nếu $\text{sign}(k_i) = \text{sign}(k_{i+1})$ thì $K_{ci} = \frac{k_i + k_{i+1}}{2}$.

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

Chương 1. Tổng quan về robot công nghiệp và xác định robot sử dụng

Chương này trình bày lịch sử hình thành, khái niệm, cấu trúc cơ bản và các lĩnh vực ứng dụng của robot công nghiệp (phục vụ máy CNC, hàn tự động, sơn tự động, đúc và rèn, cấp phôi tự động). Cấu trúc một robot công nghiệp bao gồm tay máy cơ khí, cơ cấu chấp hành (động cơ điện, thủy lực, khí nén), hệ thống cảm biến (trong và ngoài), và hệ thống điều khiển.

Dựa trên bài toán công nghệ yêu cầu:

  • Vận chuyển kiện hàng giữa hai vị trí cách nhau $1655\text{ mm}$, chênh lệch độ cao $304\text{ mm}$.
  • Tác giả xác định vị trí đặt gốc tọa độ $O_0$ của robot tại điểm chính giữa hai vị trí A và B. Bán kính làm việc tối thiểu yêu cầu là $827{,}5\text{ mm}$.
  • Đánh giá lựa chọn dòng robot: Robot IRB 1200-5/0.9 của hãng ABB có tầm với $905\text{ mm} > 827{,}5\text{ mm}$, khả năng định vị 6 bậc tự do linh hoạt trong không gian 3 chiều, đáp ứng đầy đủ các tiêu chuẩn kỹ thuật của bài toán đặt ra.

Chương 2. Động học robot

Chương 2 tập trung giải quyết trọn vẹn lý thuyết và tính toán hai bài toán động học thuận và ngược cho robot IRB 1200-5/0.9:

  • Bài toán thuận: Lược đồ hóa cấu trúc robot, gắn 6 hệ trục tọa độ theo quy tắc D-H, lập bảng thông số hình học và nhân các ma trận chuyển đổi từ $A_0^1$ đến $A_5^6$ trên phần mềm MATLAB. Kết quả thu được biểu thức ma trận $A_0^6$ kích thước $4 \times 4$ với các hàm phi tuyến chứa sin và cos của 6 biến khớp $\theta_1 \dots \theta_6$.
  • Bài toán ngược: Phân tích các khó khăn của bài toán ngược trên tay máy chuỗi hở nhiều bậc tự do (phương trình phi tuyến, đa nghiệm, nghiệm không thỏa mãn giới hạn vật lý). Đồ án thiết lập phương pháp giải số tối ưu bằng thuật toán GRG Nonlinear trong Excel Solver. Hệ thống dữ liệu đầu vào gồm 6 thông số vị trí - hướng ($P_x, P_y, P_z, S_y, A_y, A_z$) và kích thước các khâu ($d_1=399$, $a_2=448$, $a_3=42$, $d_4=451$, $d_6=82$). Solver tính toán trả về các giá trị góc quay $q_1, q_2, q_3, q_4, q_5, q_6$ với độ chính xác cao (sai số $L \to 0$).

Chương 3. Thiết kế quỹ đạo cho robot

Chương 3 trình bày việc hoạch định quỹ đạo di chuyển của tay kẹp qua 16 điểm nút trạng thái ($O_1 \to O_{16}$) trong chu trình làm việc:

  • Trình tự thao tác công nghệ:
    1. Từ vị trí chờ $O_3$, khâu cuối trượt dọc trục $z$ xuống $304\text{ mm}$ đến $O_2$.
    2. Trượt dọc trục $x$ một đoạn $320\text{ mm}$ đến $O_1$ để đầu hút hút lấy khối hàng.
    3. Lùi dọc trục $x$ một đoạn $320\text{ mm}$ về $O_2$, đồng thời khớp quay 6 xoay một góc $\theta_6 = \pi$ ($180^\circ$) để đảo chiều, giữ nguyên hướng chữ "TNUT" ở vị trí mới.
    4. Nâng lên dọc trục $z$ một khoảng $304\text{ mm}$ về lại $O_3$.
    5. Khớp 1 quay quanh trục $z$ chia thành các góc nhỏ $15^\circ$ qua các điểm $O_4, O_5, \dots, O_{15}$ sang vị trí bên kia.
    6. Khâu cuối trượt dọc trục $x$ một đoạn $320\text{ mm}$ để đặt khối hàng tại $O_{16}$.
    7. Robot thực hiện hành trình ngược lại để trở về vị trí ban đầu.
  • Nội suy quỹ đạo: Xây dựng phương trình nội suy bậc 3 cho từng khớp theo thời gian ($t_1 = 0\text{ s}$ đến $t_{32} = 31\text{ s}$). Tính toán các hệ số góc $k_i$ và hệ số góc chuyển tiếp $K_{ci}$ cho cả 6 khớp.
  • Lập trình MATLAB: Sử dụng các đoạn mã lệnh với hàm plot, hold on, grid on để xuất đồ thị quy luật chuyển động (góc quay theo thời gian) của 6 biến khớp $q_1 \dots q_6$, kiểm tra tính liên tục và độ trơn của chuyển động.
  • Mô phỏng 3D: Xuất mô hình lắp ráp hoàn chỉnh và tạo video mô phỏng động học quá trình gắp - xoay - đặt hàng của robot IRB 1200-5/0.9.

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

  • Kết quả tính toán và mô hình hóa:

    • Xây dựng thành công bảng thông số D-H và thiết lập chính xác ma trận động học thuận $A_0^6$ của robot 6 bậc tự do ABB IRB 1200-5/0.9.
    • Ứng dụng thành công phương pháp số GRG Nonlinear trên Excel Solver để giải bài toán động học ngược, thu được các bộ giá trị biến khớp $q_1 \dots q_6$ chính xác tại các điểm làm việc then chốt.
    • Hoàn thiện bảng tính toán hệ số góc $k$ và $K_{ci}$ cho 6 khớp qua 32 bước thời gian phân tán từ $t = 0\text{ s}$ đến $t = 31\text{ s}$.
    • Xuất 6 đồ thị dạng sóng mô tả quy luật biến thiên góc quay theo thời gian cho các khớp $q_1, q_2, q_3, q_4, q_5, q_6$ trên MATLAB, bảo đảm điều kiện biên vận tốc bằng $0$ tại đầu - cuối hành trình và quỹ đạo chuyển tiếp trơn tru.
    • Xây dựng video mô phỏng trực quan 3D toàn bộ chu trình gắp đặt theo yêu cầu công nghệ (được lưu trữ và chia sẻ qua liên kết video thực nghiệm).

  • Giải pháp kỹ thuật đề xuất:

    • Đề xuất kịch bản xoay bù khớp cổ tay ($\theta_6 = \pi$) trong quá trình dịch chuyển tịnh tiến từ $O_1$ về $O_2$, giải quyết trọn vẹn yêu cầu duy trì sự tương quan mặt chữ "TNUT" về cùng một phía của kiện hàng khi sang vị trí B.
    • Kết hợp linh hoạt công cụ tính toán ma trận số trên MATLAB và công cụ tối ưu hóa phi tuyến Excel Solver, giảm bớt độ phức tạp giải tích khi giải hệ phương trình động học ngược của tay máy 6 bậc tự do.

  • Đóng góp của đồ án:

    • Tự tổng hợp và hệ thống hóa quy trình thiết kế động học hoàn chỉnh: từ khảo sát yêu cầu công nghệ, lựa chọn thiết bị, lập mô hình toán học D-H, giải bài toán ngược đến thiết kế quỹ đạo nội suy bậc 3 và mô phỏng thực nghiệm.

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

  • Hạn chế được tác giả nêu trong văn bản:
    • Đồ án mới chỉ dừng lại ở phạm vi nghiên cứu động học thuần túy (vị trí, vận tốc, góc quay) mà chưa tính toán đến các yếu tố động lực học (lực tác động, mô-men quán tính, tải trọng động tại các khớp).
    • Tốc độ xử lý tính toán và thuật toán điều khiển tự động thời gian thực chưa được xây dựng hoàn chỉnh do hạn chế về mặt thời gian và kinh nghiệm chuyên môn ban đầu.
  • Hướng mở rộng nghiên cứu:
    • Nghiên cứu động lực học hệ nhiều vật để tính toán mô-men động cơ và kiểm nghiệm độ bền cơ học của các khâu.
    • Xây dựng thuật toán điều khiển phản hồi vòng kín và tích hợp cảm biến nhận dạng vị trí kiện hàng trong thời gian thực.

Giá trị tham khảo

Đồ án là tài liệu tham khảo phù hợp cho sinh viên, giảng viên và kỹ sư thuộc các chuyên ngành Kỹ thuật Cơ điện tử, Robot và Trí tuệ nhân tạo, Tự động hóa, Kỹ thuật Cơ khí.

Các phần nội dung có giá trị ứng dụng cao gồm:

  • Quy trình chuẩn thiết lập bảng D-H và ma trận biến đổi thuần nhất cho robot công nghiệp 6 bậc tự do cấu hình nối tiếp.
  • Phương pháp ứng dụng Excel Solver (GRG Nonlinear) để giải số bài toán động học ngược một cách nhanh chóng, trực quan mà không cần giải tích ma trận nghịch đảo phức tạp.
  • Đoạn mã lệnh MATLAB và phương pháp nội suy hàm bậc 3 ứng dụng trong quy hoạch quỹ đạo chuyển động mượt mà cho các khớp tay máy.

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

1. Tại sao tác giả lại lựa chọn robot ABB IRB 1200-5/0.9 cho bài toán công nghệ này?
Khoảng cách giữa hai vị trí đặt kiện hàng là $1655\text{ mm}$. Khi đặt robot ở chính giữa, bán kính thao tác tối thiểu yêu cầu là $827{,}5\text{ mm}$. Dòng robot ABB IRB 1200-5/0.9 có tầm với thiết kế đạt $905\text{ mm}$ ($> 827{,}5\text{ mm}$) và cấu trúc 6 bậc tự do, đáp ứng đủ không gian làm việc 3 chiều và độ linh hoạt theo yêu cầu.

2. Các kích thước hình học chính ($d_i, a_i$) của robot IRB 1200-5/0.9 được sử dụng trong tính toán D-H là bao nhiêu?
Các thông số hình học được trích xuất gồm: $d_1 = 399\text{ mm}$ (chiều cao đế đến khớp 2), $a_2 = 448\text{ mm}$ (chiều dài khâu cánh tay), $a_3 = 42\text{ mm}$ (độ lệch khâu 3), $d_4 = 451\text{ mm}$ (chiều dài cẳng tay), và $d_6 = 82\text{ mm}$ (khoảng cách khớp 5 đến khâu chấp hành cuối).

3. Phương pháp nào được sử dụng để giải bài toán động học ngược trong đồ án?
Tác giả sử dụng phương pháp tối ưu hóa phi tuyến GRG Nonlinear (Generalized Reduced Gradient) tích hợp trong công cụ Solver của Microsoft Excel để tìm nghiệm gần đúng của 6 biến khớp $q_1 \dots q_6$, thông qua việc triệt tiêu hàm mục tiêu tổng bình phương sai số tọa độ $L = \sum_{j=1}^6 L_j \to 0$.

4. Robot thực hiện yêu cầu giữ nguyên hướng mặt chữ "TNUT" của kiện hàng bằng cách nào?
Sau khi hút khối hàng tại vị trí $O_1$ và lùi về vị trí $O_2$, robot điều khiển khớp quay thứ 6 ($\theta_6$) quay một góc bằng $\pi$ ($180^\circ$). Việc này giúp bù lại sự đổi hướng khi cánh tay quay toàn bộ cụm sang vị trí đối diện, giữ cho mặt chữ "TNUT" luôn hướng về cùng một phía ban đầu.

5. Dạng hàm toán học nào được dùng để nội suy quỹ đạo trong không gian khớp?
Tác giả sử dụng hàm đa thức bậc 3 có dạng $u(t) = a_1 t^3 + b_1 t^2 + c_1 t + d_1$, kết hợp các điều kiện biên về vận tốc tại điểm đầu/cuối bằng $0$ và điều kiện tiếp tuyến trơn tại các điểm nút chuyển tiếp.

Kết luận

Đồ án môn học "Thiết kế và tính toán động học cho robot thực hiện nhiệm vụ theo yêu cầu công nghệ" của sinh viên Lê Công Minh đã hoàn thành việc mô hình hóa, tính toán động học thuận - ngược và thiết kế quỹ đạo làm việc cho robot 6 bậc tự do ABB IRB 1200-5/0.9 phục vụ gắp đặt kiện hàng. Bằng việc kết hợp hiệu quả phương pháp D-H, thuật toán tối ưu số GRG Nonlinear trên Excel, cùng các công cụ MATLAB và mô phỏng CAD, nghiên cứu đã chứng minh tính khả thi về mặt hình học và chuyển động của hệ thống robot theo đúng yêu cầu công nghệ đặt ra. Đây là tài liệu tham khảo có tính hệ thống cao trong việc ứng dụng toán học và tin học chuyên ngành vào bài toán động học robot công nghiệp.