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

Trong bối cảnh công nghiệp hóa và hiện đại hóa, việc ứng dụng tự động hóa và công nghệ robot vào sản xuất cũng như đời sống là xu thế tất yếu nhằm nâng cao năng suất, đảm bảo an toàn lao động và giảm thiểu chi phí. Công nghệ chế tạo robot ngày càng phát triển nhằm đáp ứng các nhu cầu đa dạng trong sản xuất công nghiệp, dịch vụ sinh hoạt, an ninh và quốc phòng. Robot có khả năng đảm nhận các công việc đòi hỏi độ chính xác cao hoặc hoạt động trong những môi trường nguy hiểm đối với con người như khu vực nhiễm phóng xạ, rà phá bom mìn, cứu hộ thảm họa và thám hiểm không gian.

Trong các nhóm robot, robot di động (Mobile Robot) sở hữu khả năng vận động linh hoạt, không bị cố định vị trí làm việc. Tuy nhiên, các dòng robot di động sử dụng bánh xe truyền thống thường gặp nhiều hạn chế khi di chuyển trên địa hình gồ ghề, chật hẹp, bậc thang hoặc bề mặt phức tạp. Nhằm khắc phục nhược điểm này, mô hình robot di động nhiều chân mô phỏng sinh học, cụ thể là robot bốn chân (Dog Robot), được lựa chọn nghiên cứu. Bên cạnh ưu thế về khả năng thích ứng địa hình, kiểu dáng phỏng sinh học dạng chú chó mang lại sự thân thiện, giảm bớt tâm lý e ngại của con người đối với các hệ thống máy móc công nghiệp.

Đồ án tập trung giải quyết các nhiệm vụ và mục tiêu nghiên cứu cụ thể sau:

  1. Thiết kế hoàn chỉnh mô hình hình học 3D và các bản vẽ chế tạo chi tiết cho toàn bộ khung thân, cụm vai và chân của Dog Robot.
  2. Ứng dụng công nghệ in 3D FDM để chế tạo thực tế phần khung vỏ nhằm tối ưu hóa trọng lượng, độ chính xác lắp ghép và tiết kiệm chi phí.
  3. Phân tích cơ sở lý thuyết động học và động lực học: thiết lập bảng thông số Denavit - Hartenberg (D-H), giải bài toán động học thuận và động học nghịch cho chân robot; thiết lập ma trận Jacobi và phương trình động lực học Lagrange - Euler.
  4. Lựa chọn linh kiện, xây dựng sơ đồ khối và thiết kế hệ thống điều khiển phần cứng tích hợp vi xử lý Raspberry Pi Zero 2 W, module điều khiển động cơ servo PCA9685, cảm biến gia tốc MPU6050 và khối nguồn.
  5. Lắp ráp hoàn thiện mô hình thực nghiệm và kiểm tra khả năng vận hành của các khớp chuyển động.

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

  • Đối tượng nghiên cứu: Cấu trúc cơ khí, mô hình động học và hệ thống điều khiển chuyển động của robot bốn chân phỏng sinh học.
  • Phạm vi nghiên cứu: Giới hạn ở việc thiết kế cơ khí cho mô hình Dog Robot cỡ nhỏ di chuyển trên mặt phẳng và địa hình cơ bản (không bao gồm khả năng leo tường hoặc bay lượn); khảo sát động học cho cơ cấu chân 3 bậc tự do; chế tạo khung vỏ bằng vật liệu nhựa in 3D; điều khiển các khớp thông qua động cơ RC Servo điều khiển xung PWM.

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

Đồ án ứng dụng hệ thống cơ sở lý thuyết chuẩn mực trong lĩnh vực robot học và kỹ thuật cơ điện tử:

  • Lý thuyết Động học Robot (Kinematics): Sử dụng phương pháp Denavit - Hartenberg (D-H) để gắn hệ trục tọa độ lên các khâu khớp theo quy tắc bàn tay phải (quy tắc tam diện thuận). Xác định 4 thông số hình học ($\theta_i, a_i, d_i, \alpha_i$) để xây dựng ma trận biến đổi thuần nhất $^{i-1}A_i$ biểu diễn vị trí và hướng của cơ cấu chấp hành cuối (đầu bàn chân) so với gốc tọa độ tham chiếu.
  • Lý thuyết Động học Vận tốc và Ma trận Jacobi: Sử dụng ma trận Jacobi $[J]$ biểu diễn mối quan hệ vi phân tuyến tính giữa vận tốc góc của các biến khớp với vận tốc dài và vận tốc góc của điểm công tác cuối theo thời gian: $$\begin{bmatrix} V_x \ V_y \ V_z \end{bmatrix} = [J] \begin{bmatrix} \omega_x \ \omega_y \ \omega_z \end{bmatrix}$$
  • Lý thuyết Động lực học Robot (Dynamics): Áp dụng nguyên lý năng lượng Lagrange - Euler để thiết lập phương trình chuyển động của hệ thống nhiều bậc tự do, bỏ qua sự phân bố khối lượng phức tạp và động lực học bên trong động cơ: $$L = K - P$$ $$\tau_i = \frac{d}{dt}\left(\frac{\partial L}{\partial \dot{q}_i}\right) - \frac{\partial L}{\partial q_i}$$ Trong đó, $K$ là tổng động năng (bao gồm động năng tịnh tiến $\frac{1}{2}mv^2$ và động năng quay $\frac{1}{2}I\omega^2$), $P$ là thế năng trọng trường ($mgh$), $q$ là biến khớp và $\tau$ là mô-men dẫn động cần thiết tại các khớp.

Phương pháp nghiên cứu thực nghiệm và công cụ hỗ trợ:

  • Phương pháp giải tích và mô phỏng tính toán: Ứng dụng phần mềm MATLAB để giải hệ ma trận biến đổi thuần nhất, tính toán các biểu thức tọa độ vị trí đầu công tác trong bài toán động học thuận và nghịch.
  • Phương pháp thiết kế CAD 3D và chế tạo mẫu nhanh (Rapid Prototyping): Sử dụng phần mềm thiết kế cơ khí chuyên dụng để mô hình hóa toàn bộ các chi tiết; ứng dụng công nghệ in 3D FDM (Fused Deposition Modeling) để tạo hình khung thân và các khâu khớp.
  • Phương pháp tích hợp hệ thống cơ điện tử: Thiết kế mạch kết nối giữa vi điều khiển trung tâm, driver điều khiển xung PWM đa kênh và hệ thống cảm biến quán tính.

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

Hệ thống Dog Robot được thiết kế đồng bộ từ cấu trúc cơ khí đến kiến trúc phần cứng điều khiển:

1. Kiến trúc cơ khí và cấu trúc khung vỏ

Cơ cấu cơ khí của robot gồm ba cụm chính:

  • Cụm thân: Bao gồm tấm thân dưới, tấm thân trên và các tấm chắn hông (trái/phải) tạo thành khoang chứa bảo vệ các mạch điện tử, vi xử lý và pin.
  • Cụm vai: Gồm 4 khớp vai được bố trí đối xứng ở bốn góc thân, cho phép chân chuyển động xoay linh hoạt quanh trục thân.
  • Cụm chân: Mỗi chân gồm 3 khâu tương ứng với 3 bậc tự do (khớp hông/vai, khớp đùi và khớp cẳng chân), kết thúc bằng đệm chân tiếp xúc đất có khả năng giảm chấn. Toàn bộ các bộ phận được in 3D FDM giúp giảm trọng lượng bản thân của robot, thuận tiện cho việc tháo lắp, căn chỉnh và thay thế khi gặp sự cố.

2. Kiến trúc phần cứng và sơ đồ kết nối điều khiển

Hệ thống điều khiển trung tâm sử dụng kiến trúc phân tầng xử lý:

Tên linh kiện / Module Chức năng kỹ thuật trong hệ thống Đặc tính thông số chính
Raspberry Pi Zero 2 W Bộ xử lý trung tâm, quản lý luồng điều khiển và thuật toán CPU lõi tứ, tích hợp Wi-Fi/Bluetooth, kích thước nhỏ gọn
PCA9685 Module mở rộng điều khiển động cơ servo 16 kênh PWM, độ phân giải 12-bit, giao tiếp qua bus I2C
MPU6050 Cảm biến quán tính đo góc nghiêng và gia tốc Tích hợp con quay hồi chuyển 3 trục và gia tốc kế 3 trục
RC Servo MG996R Động cơ chấp hành tại các khớp chuyển động Bánh răng kim loại, mô-men xoắn cao, điều khiển góc bằng xung
Mạch hạ áp M249 Điều chỉnh và ổn định điện áp cho tải servo Đầu ra USB 5V - 6A, công suất định mức 30W
Pin 18650 & Mạch báo 4S Nguồn cấp động lực và hiển thị mức năng lượng Bộ pin sạc Lithium-ion kết hợp mạch LED báo dung lượng 1S-4S

Trong quá trình vận hành, Raspberry Pi Zero 2 W giao tiếp với module PCA9685 thông qua chuẩn truyền thông I2C để phát tín hiệu xung PWM điều khiển đồng thời 12 động cơ servo MG996R (3 động cơ cho mỗi chân $\times$ 4 chân). Cảm biến MPU6050 liên tục phản hồi dữ liệu góc nghiêng thân robot về bộ xử lý để phục vụ việc giữ cân bằng. Nguồn điện từ pin 18650 được hạ áp ổn định qua mạch M249 nhằm đáp ứng dòng tức thời lớn khi các động cơ servo cùng hoạt động.

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

Chương 1: Tổng quan về Robot

Chương này hệ thống hóa các khái niệm nền tảng về người máy, nguồn gốc lịch sử của thuật ngữ "Robota" xuất phát từ tác phẩm kịch "Rossum's Universal Robots" và định nghĩa robot hiện đại. Nhóm tác giả phân tích các đặc trưng cơ bản của robot như khả năng nhận biết môi trường, tương tác vật thể và chuyển động đa bậc tự do. Đi sâu vào phân loại Mobile Robot, chương làm rõ ưu thế về tính linh hoạt khi làm việc trong không gian mở, đồng thời chỉ ra nhược điểm phức tạp trong điều khiển định vị. Tác giả luận chứng việc lựa chọn công nghệ in 3D FDM để chế tạo khung vỏ nhằm đảm bảo tiêu chí dễ tháo lắp, tính thẩm mỹ, giá thành hợp lý và giải thích lý do lựa chọn cơ cấu chân thay cho bánh xe để đáp ứng môi trường hoạt động hiểm trở.

Chương 2: Thiết kế Robot

Chương 2 trình bày chi tiết kết quả thiết kế không gian 3D và các bản vẽ kỹ thuật chế tạo của toàn bộ hệ thống Dog Robot. Nội dung chương cung cấp các bản vẽ kỹ thuật chi tiết của từng cụm chi tiết:

  • Cụm thân: bản vẽ thân dưới, thân trên và tấm chắn hông hai bên.
  • Cụm vai và chân: bản vẽ thiết kế 4 khớp vai riêng biệt, khớp truyền động, khớp đùi, khớp chân và kết cấu đệm bàn chân.
  • Bản vẽ lắp tổng thể: thể hiện vị trí tích hợp của 12 động cơ servo và các khoang lắp đặt linh kiện điện tử trên bộ khung robot.

Chương 3: Tính toán động học Robot

Chương 3 tập trung vào cơ sở toán học của chuyển động robot. Nhóm tác giả trình bày phương pháp Denavit - Hartenberg, quy tắc đặt hệ trục tọa độ tại các khớp theo quy tắc bàn tay phải và ma trận chuyển đổi tổng quát $^{i-1}A_i$. Trên cơ sở cấu trúc chân robot 3 bậc tự do, bảng thông số D-H được xác lập cụ thể:

Khâu ($i$) Góc quay biến khớp ($\theta_i$) Chiều dài khâu ($a_i$) Độ dịch chuyển khâu ($d_i$) Góc xoắn khâu ($\alpha_i$)
01 $\theta_1$ 0 $L_1$ $-90^\circ$
12 $\theta_2$ $L_2$ 0 $0^\circ$
23 $\theta_3$ $L_3$ 0 $0^\circ$

Sử dụng phần mềm MATLAB, nhóm tác giả tính toán các ma trận biến đổi thuần nhất của từng khâu:

  • Ma trận khâu 1: $$T_{01} = \begin{bmatrix} \cos(\theta_1) & 0 & -\sin(\theta_1) & 0 \ \sin(\theta_1) & 0 & \cos(\theta_1) & 0 \ 0 & -1 & 0 & L_1 \ 0 & 0 & 0 & 1 \end{bmatrix}$$
  • Ma trận khâu 2: $$T_{12} = \begin{bmatrix} \cos(\theta_2) & -\sin(\theta_2) & 0 & L_2\cos(\theta_2) \ \sin(\theta_2) & \cos(\theta_2) & 0 & L_2\sin(\theta_2) \ 0 & 0 & 1 & 0 \ 0 & 0 & 0 & 1 \end{bmatrix}$$
  • Ma trận khâu 3: $$T_{23} = \begin{bmatrix} \cos(\theta_3) & -\sin(\theta_3) & 0 & L_3\cos(\theta_3) \ \sin(\theta_3) & \cos(\theta_3) & 0 & L_3\sin(\theta_3) \ 0 & 0 & 1 & 0 \ 0 & 0 & 0 & 1 \end{bmatrix}$$

Tổng hợp ma trận biến đổi toàn phần $T_{03} = T_{01} \cdot T_{12} \cdot T_{23}$, nghiệm của bài toán động học thuận xác định tọa độ điểm công tác cuối ($P_x, P_y, P_z$) của bàn chân robot được biểu diễn tường minh:

  • $P_x = \cos(\theta_1) \cdot [L_3\cos(\theta_2 + \theta_3) + L_2\cos(\theta_2)]$
  • $P_y = \sin(\theta_1) \cdot [L_3\cos(\theta_2 + \theta_3) + L_2\cos(\theta_2)]$
  • $P_z = L_1 - L_3\sin(\theta_2 + \theta_3) - L_2\sin(\theta_2)$

Bên cạnh đó, chương phân tích bài toán động học nghịch, động học vận tốc thông qua ma trận Jacobi và thiết lập phương trình vi phân động lực học Lagrange - Euler để tính toán mô-men dẫn động yêu cầu tại các khớp.

Chương 4: Thiết kế bộ điều khiển

Chương 4 thuyết minh giải pháp điều khiển phần cứng. Nội dung chương phân tích sơ đồ khối tổng thể, sơ đồ kết nối điện tử và vai trò của từng linh kiện cấu thành hệ thống: board máy tính nhúng Raspberry Pi Zero 2 W đóng vai trò điều khiển chính, module PCA9685 nhận lệnh từ giao tiếp I2C để xuất tín hiệu PWM 12-bit điều khiển 12 động cơ servo MG996R, module cảm biến gia tốc MPU6050 ghi nhận trạng thái thăng bằng của thân, mạch hạ áp M249 (USB 5V-6A 30W) và khối pin 18650 kèm mạch LED hiển thị mức dung lượng pin 4S.

Chương 5: Kết quả thực nghiệm và đánh giá

Chương 5 trình bày kết quả gia công, lắp ráp hoàn thiện mô hình cơ khí Dog Robot và tích hợp mạch điều khiển phần cứng. Nhóm tiến hành thử nghiệm cấp nguồn, kiểm tra tín hiệu điều khiển góc quay của các động cơ servo tại các khớp vai, đùi và cẳng chân, đánh giá sự ăn khớp giữa bản vẽ thiết kế 3D và sản phẩm thực tế.

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

Chương tổng kết các hạng mục đã hoàn thành về mặt thiết kế kết cấu, xây dựng mô hình toán động học và chế tạo mô hình vật lý. Đồng thời, tác giả đề xuất định hướng phát triển nhằm nâng cao chất lượng vận hành của robot trong các giai đoạn tiếp theo.

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

Đồ án ghi nhận các kết quả kỹ thuật cụ thể:

  • Hoàn thành bộ bản vẽ thiết kế 3D chi tiết các bộ phận cấu thành Dog Robot (khung thân, 4 vai, các khớp đùi, cẳng chân, đệm chân) và chế tạo thành công toàn bộ khung vỏ vật lý bằng phương pháp in 3D FDM.
  • Thiết lập thành công bảng thông số D-H và giải tường minh hệ phương trình động học thuận xác định chính xác tọa độ vị trí đầu công tác ($P_x, P_y, P_z$) theo các góc biến khớp ($\theta_1, \theta_2, \theta_3$) và chiều dài các khâu ($L_1, L_2, L_3$) thông qua phần mềm MATLAB.
  • Xây dựng hoàn chỉnh sơ đồ khối phần cứng điều khiển nhúng phân tán, kết nối thành công máy tính nhúng Raspberry Pi Zero 2 W với module mở rộng 16 kênh PWM PCA9685 qua bus I2C để điều khiển 12 động cơ RC Servo MG996R, kết hợp cảm biến MPU6050 và hệ thống quản lý nguồn pin 18650 / mạch hạ áp 5V-6A.
  • Chế tạo và lắp ráp hoàn thiện mô hình thực nghiệm Dog Robot hoạt động ổn định về mặt cơ điện tử.

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

  • Hiện thực hóa quy trình từ tính toán lý thuyết động học nhiều bậc tự do đến thiết kế, chế tạo mẫu nhanh bằng in 3D cho dòng robot bốn chân với chi phí thấp.
  • Đặt nền tảng phần cứng và mô hình toán học giải tích phục vụ cho các nghiên cứu chuyên sâu tiếp theo về thuật toán điều khiển bước đi phỏng sinh học.

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

Hạn chế của đồ án:

  • Nội dung đồ án còn nặng về cơ sở lý thuyết tính toán động học và thiết kế tĩnh; việc phân tích động lực học thực tế (tính toán tải trọng quán tính, va đập khi tiếp đất) chưa được kiểm chứng đầy đủ bằng số liệu thực nghiệm.
  • Thuật toán điều khiển bước đi tự động và khả năng tự cân bằng thời gian thực dựa trên dữ liệu phản hồi từ cảm biến gia tốc MPU6050 chưa được tối ưu hóa chuyên sâu.
  • Mô hình thử nghiệm chủ yếu đánh giá hoạt động của các khớp động cơ riêng lẻ, chưa triển khai thử nghiệm diện rộng trên nhiều dạng địa hình phức tạp ngoài thực tế.

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

  • Hoàn thiện thuật toán điều khiển động lực học và giải bài toán động học nghịch thời gian thực để tạo ra các dáng đi (gait patterns) linh hoạt như bước chậm (walk), chạy bước kiệu (trot).
  • Lập trình tích hợp sâu dữ liệu từ cảm biến quán tính MPU6050 vào vòng lặp điều khiển phản hồi kín nhằm tự động bù góc nghiêng, giữ cân bằng thân khi di chuyển qua dốc hoặc gặp ngoại lực tác động.
  • Tích hợp thêm cảm biến khoảng cách, camera và các thuật toán xử lý ảnh trên Raspberry Pi để robot có khả năng nhận biết vật cản, quan sát môi trường và tự hành.

Giá trị tham khảo

Đồ án là tài liệu tham khảo hữu ích cho sinh viên, giảng viên và kỹ sư thuộc các chuyên ngành Công nghệ Kỹ thuật Cơ điện tử, Kỹ thuật Điều khiển và Tự động hóa, Kỹ thuật Robot:

  • Phần tính toán động học (Chương 3): Cung cấp phương pháp thiết lập hệ trục tọa độ D-H chuẩn xác cho cơ cấu chân robot 3 bậc tự do và quy trình lập trình giải ma trận biến đổi thuần nhất trên MATLAB, rất hữu ích cho các đề tài nghiên cứu về tay máy và robot chân.
  • Phần thiết kế cơ khí và điều khiển phần cứng (Chương 2 & Chương 4): Là tài liệu tham khảo thực tế về việc phân rã kết cấu cơ khí phục vụ công nghệ in 3D FDM, cũng như giải pháp phối ghép phần cứng giữa Raspberry Pi và driver PCA9685 điều khiển số lượng lớn động cơ servo qua bus I2C.

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

1. Mỗi chân của Dog Robot trong đồ án có bao nhiêu bậc tự do và sử dụng loại động cơ nào?
Mỗi chân của robot được thiết kế với 3 bậc tự do tương ứng với 3 khớp chuyển động ($\theta_1, \theta_2, \theta_3$). Toàn bộ robot gồm 4 chân với tổng cộng 12 bậc tự do, sử dụng 12 động cơ RC Servo MG996R bánh răng kim loại có mô-men xoắn cao.

2. Bảng thông số D-H cho một chân của Dog Robot được xác lập như thế nào?
Bảng thông số D-H cho một chân gồm 3 khâu: Khâu 01 có góc quay biến khớp $\theta_1$, chiều dài $a_1 = 0$, độ dịch chuyển $d_1 = L_1$, góc xoắn $\alpha_1 = -90^\circ$; Khâu 12 có góc quay biến khớp $\theta_2$, chiều dài $a_2 = L_2$, độ dịch chuyển $d_2 = 0$, góc xoắn $\alpha_2 = 0^\circ$; Khâu 23 có góc quay biến khớp $\theta_3$, chiều dài $a_3 = L_3$, độ dịch chuyển $d_3 = 0$, góc xoắn $\alpha_3 = 0^\circ$.

3. Phương trình tọa độ điểm công tác cuối của chân robot trong bài toán động học thuận là gì?
Dựa trên ma trận biến đổi $T_{03} = T_{01} \cdot T_{12} \cdot T_{23}$, tọa độ vị trí đầu chân robot ($P_x, P_y, P_z$) được xác định bởi:

  • $P_x = \cos(\theta_1) \cdot [L_3\cos(\theta_2 + \theta_3) + L_2\cos(\theta_2)]$
  • $P_y = \sin(\theta_1) \cdot [L_3\cos(\theta_2 + \theta_3) + L_2\cos(\theta_2)]$
  • $P_z = L_1 - L_3\sin(\theta_2 + \theta_3) - L_2\sin(\theta_2)$

4. Khung vỏ của Dog Robot được chế tạo bằng công nghệ nào và có ưu điểm gì?
Khung vỏ của robot được thiết kế 3D và chế tạo bằng công nghệ in 3D FDM. Phương pháp này giúp kết cấu có trọng lượng nhẹ, tối ưu hóa không gian bố trí mạch điện tử, dễ dàng tháo lắp sửa chữa và tiết kiệm đáng kể chi phí so với gia công kim loại.

5. Giải pháp điều khiển phần cứng của robot được tổ chức như thế nào?
Hệ thống sử dụng vi xử lý Raspberry Pi Zero 2 W làm bộ điều khiển trung tâm, phát lệnh qua giao tiếp I2C tới module PCA9685 để tạo 16 kênh xung PWM 12-bit điều khiển 12 động cơ servo MG996R. Trạng thái nghiêng của robot được đo bằng cảm biến gia tốc 6 trục MPU6050, toàn bộ hệ thống nhận nguồn từ khối pin 18650 qua mạch hạ áp M249 (5V-6A, 30W) và mạch giám sát pin 4S.

Kết luận

Đồ án "Thiết kế, điều khiển Dog Robot" đã hoàn thành trọn vẹn các mục tiêu nghiên cứu cơ bản bao gồm thiết kế mô hình 3D, chế tạo khung vỏ bằng công nghệ in 3D FDM, xây dựng cơ sở toán học động học D-H/MATLAB và tích hợp thành công phần cứng điều khiển nhúng với 12 bậc tự do. Kết quả của đề tài khẳng định tính khả thi trong việc phát triển mô hình robot bốn chân phỏng sinh học chi phí thấp phục vụ công tác nghiên cứu, đào tạo cơ điện tử. Đây là tiền đề quan trọng để tiếp tục tối ưu hóa các giải thuật tự cân bằng và điều khiển bước đi thích nghi trên các địa hình phức tạp trong tương lai.