Giới thiệu dự án

Trong kỷ nguyên công nghiệp 4.0 và tự động hóa nâng cao, robot di động (Mobile Robot) đóng vai trò then chốt trong việc thay thế con người thực hiện các nhiệm vụ nguy hiểm tại các môi trường khắc nghiệt như thám hiểm không gian, cứu hộ thiên tai, rà phá bom mìn và giám sát công trình công nghiệp ngầm. Theo các báo cáo phân tích thị trường robot toàn cầu, phân khúc robot dạng chân (Legged Robots) đang đạt tốc độ tăng trưởng kép hàng năm (CAGR) trên 18.5%, vượt trội hơn robot bánh xe truyền thống trong các ứng dụng địa hình phi cấu trúc nhờ khả năng vượt chướng ngại vật gián đoạn và tính cơ động sinh học cao.

                  +-----------------------------------+
                  |   BỘ ĐIỀU KHIỂN TRUNG TÂM         |
                  |     Arduino Mega 2560             |
                  |     (ATmega2560 @ 16MHz)          |
                  +-----------------+-----------------+
                                    |
                                    | 18 Kênh PWM (50Hz)
                                    v
                  +-----------------+-----------------+
                  |   MEGA SENSOR SHIELD V2.0         |
                  |  (Phân phối tín hiệu & Nguồn riêng)|
                  +--------+-----------------+--------+
                           |                 |
         +-----------------+                 +-----------------+
         |                                                     |
         v                                                     v
+--------+--------+                                   +--------+--------+
| 6 CHÂN ROBOT    |                                   | KHỐI NGUỒN CÔNG |
| (Mỗi chân 3-DOF)|                                   | SUẤT CAO        |
| - Coza (Link 1) |                                   | - Pin LiPo 3S   |
| - Femur (Link 2)|                                   |   11.1V 2200mAh |
| - Tibia (Link 3)|                                   | - Buck DC-DC    |
| -> 18x FR1501   |                                   |   12A / 95% Eff |
+-----------------+                                   +-----------------+

Vấn đề cốt lõi đặt ra trong nghiên cứu hệ thống di động đa chân là độ phức tạp cơ điện tử cao: một robot nhện 6 chân (Hexapod Robot) sở hữu tới 18 bậc tự do (Degrees of Freedom - DOF), đòi hỏi khối lượng tính toán động học thời gian thực lớn, phân phối tải trọng liên tục và quản lý đồng bộ 18 cơ cấu chấp hành. Đồ án "Thiết kế, thi công và lập trình điều khiển Robot nhện 6 chân" giải quyết trực tiếp bài toán tính toán động học, tối ưu dáng đi (Gait Planning) và tích hợp phần cứng tối ưu chi phí nhưng vẫn đảm bảo độ chính xác chuyển động.

Mục tiêu của dự án

  1. Thiết kế cơ khí chính xác: Xây dựng mô hình 3D toàn diện cho khung thân và 6 cụm chân đối xứng trên phần mềm SolidWorks 2015, tối ưu hóa vật liệu Mica đen 3mm đảm bảo tỷ số độ bền/khối lượng.
  2. Xây dựng mô hình động học: Thiết lập bảng thông số Denavit-Hartenberg (D-H), giải phương trình động học thuận (Forward Kinematics - FK) và động học nghịch (Inverse Kinematics - IK) cho từng cụm chân 3-DOF.
  3. Phát triển thuật toán điều khiển dáng đi: Lập trình tạo quỹ đạo di chuyển theo dáng đi liên tục (Tripod Gait) và dáng đi không liên tục (Wave Gait/Ripple Gait), kết hợp ma trận xoay góc Euler (Roll, Pitch, Yaw) và tịnh tiến tọa độ thân giữa.
  4. Thi công và tích hợp hệ thống phần cứng: Kết nối vi điều khiển ATmega2560 với 18 động cơ RC Servo Digital FR1501 (lực kéo 17 kg·cm), tích hợp mạch giảm áp DC-DC công suất 100W và pin Lithium Polymer (LiPo) 3S.

Phạm vi và giới hạn đề tài

  • Phạm vi nghiên cứu: Robot 6 chân đối xứng, mỗi chân gồm 3 khâu tương ứng với 3 khớp quay ($a_1 = 25\text{ mm}$, $a_2 = 70\text{ mm}$, $a_3 = 65\text{ mm}$).
  • Giới hạn kỹ thuật: Góc quay giới hạn của Servo trong khoảng $0^\circ - 180^\circ$; quỹ đạo di chuyển tối ưu trên địa hình phẳng nằm ngang; hệ thống sử dụng thuật toán điều khiển vòng hở (Open-loop control) cho dáng đi cơ sở.

Phân tích và thiết kế giải pháp

Phân tích hiện trạng

Trong phân loại robot di động, các cơ cấu chuyển động phổ biến bao gồm robot bánh xe (Wheeled Robot), robot bánh xích (Tracked Robot) và robot dạng chân (Legged Robot - Biped, Quadruped, Hexapod).

Tiêu chí so sánh Robot bánh xe (Wheeled AGV) Robot 4 chân (Quadruped) Robot nhện 6 chân (Hexapod đề tài)
Khả năng vượt địa hình gồ ghề Kém, chỉ hoạt động trên mặt phẳng Khá, vượt được bậc thang thấp Rất cao, thích nghi tốt địa hình gồ ghề
Độ ổn định tĩnh (Static Stability) Rất cao khi đứng yên Trung bình (cần thuật toán cân bằng) Cực cao (luôn duy trì ít nhất 3 chân tiếp đất)
Độ phức tạp điều khiển (DOF) Thấp (2 - 4 động cơ DC) Cao (8 - 12 DOF) Rất cao (18 DOF, giải FK/IK đồng thời)
Chi phí chế tạo & Bảo trì Thấp Rất cao (yêu cầu Servo đắt tiền) Tối ưu, linh kiện phổ biến

Yêu cầu hệ thống theo mô hình MoSCoW

  • Must-have (Bắt buộc): Giải thuật nghịch động học (IK) giải tích thời gian thực trên vi điều khiển 8-bit; xuất 18 kênh xung PWM 50Hz độc lập; ổn định điện áp cấp cho servo khi dòng tải đột biến $>6\text{A}$.
  • Should-have (Nên có): Dáng đi Tripod linh hoạt cho tốc độ cao và Wave Gait cho độ ổn định tối đa; chuyển hướng mượt thông qua biến đổi ma trận Roll/Pitch/Yaw.
  • Could-have (Có thể mở rộng): Tích hợp cảm biến siêu âm hoặc quang học để phát hiện chướng ngại vật phía trước.
  • Won't-have (Chưa thực hiện): Động lực học phức tạp có xét đến ma sát bề mặt tiếp xúc và phân bố phản lực đất bằng cảm biến lực chân (Force Sensor).

Thiết kế hệ thống

Kiến trúc phần cứng được chia làm 3 phân hệ chính: Phân hệ điều khiển trung tâm, Phân hệ dẫn động cơ điện tử và Phân hệ quản lý năng lượng.

+-------------------------------------------------------------------------+
|                           KIẾN TRÚC TOÀN HỆ THỐNG                       |
+-------------------------------------------------------------------------+
|                                                                         |
|  +--------------------+     UART (115200 bps)     +------------------+  |
|  | Cảm biến ngoại vi  | ------------------------> | Arduino Mega     |  |
|  | (Sensor1 - Pin 22) |                           | 2560             |  |
|  +--------------------+                           | (ATmega2560)     |  |
|                                                   +--------+---------+  |
|                                                            |            |
|                                      18 Kênh PWM (D8-D44)  |            |
|                                                            v            |
|  +--------------------+  Điện áp 5V-6V (Dòng max 12A) +----+----------+ |
|  | Nguồn LiPo 3S      | ============================> | Mega Sensor   | |
|  | 11.1V 2200mAh 30C  |      (Qua Mạch Giảm Áp Buck)  | Shield V2.0   | |
|  +--------------------+                               +----+----------+ |
|                                                            |            |
|               +--------------------+-----------------------+            |
|               |                    |                       |            |
|               v                    v                       v            |
|        +---------------+    +---------------+       +---------------+   |
|        | Cụm Chân 1,2  |    | Cụm Chân 3,4  |       | Cụm Chân 5,6  |   |
|        | (6x FR1501)   |    | (6x FR1501)   |       | (6x FR1501)   |   |
|        +---------------+    +---------------+       +---------------+   |
+-------------------------------------------------------------------------+

Ngăn xếp công nghệ phần cứng và phần mềm

  • Phần mềm thiết kế CAD: SolidWorks 2015 (xây dựng Assembly 18 khớp, tối ưu kết cấu phân bố trọng tâm).
  • Môi trường lập trình: Arduino IDE v1.8.x, trình biên dịch avr-gcc, thư viện <Servo.h>.
  • Vi điều khiển trung tâm: Arduino Mega 2560 R3 (Chip ATmega2560, Clock 16 MHz, 256 KB Flash, 8 KB SRAM, 4 KB EEPROM, 54 chân Digital I/O).
  • Shield mở rộng: Mega Sensor Shield V2.0 tích hợp chân cắm 3-pin (VCC-GND-Signal) cho toàn bộ 18 động cơ và tách rời đường nguồn động lực với nguồn logic.
  • Cơ cấu chấp hành: 18 Động cơ Digital RC Servo FR1501 (Bánh răng kim loại, góc quét $180^\circ$, lực kéo $17\text{ kg}\cdot\text{cm}$ tại 4.8V-6V, thời gian đáp ứng xung $1\text{ ms} - 2\text{ ms}$ tại tần số $50\text{ Hz}$).
  • Nguồn điện: Pin LiPo 3S 11.1V 2200mAh (Dòng xả định mức 30C, dòng xả tức thời lên tới 66A) kết hợp Mạch giảm áp DC-DC Buck (Dải điện áp vào 4.5–30V, ra 1.25–30V, hiệu suất chuyển đổi 95%, tần số đóng cắt 300 kHz, dòng tải tối đa 12A).

Phương pháp nghiên cứu và phát triển

Dự án áp dụng quy trình phát triển lặp nhanh theo mô hình chữ V cải tiến cho hệ thống nhúng (Embedded V-Model):

  1. Giai đoạn 1 (Tuần 1 - 3): Nghiên cứu lý thuyết động học D-H, tính toán ma trận thuần nhất, mô phỏng nghiệm FK/IK trên phần mềm toán học.
  2. Giai đoạn 2 (Tuần 4 - 6): Thiết kế 3D các chi tiết Link 1 (Coza), Link 2 (Femur), Link 3 (Tibia) và khung thân trên SolidWorks 2015; gia công cắt laser Mica 3mm.
  3. Giai đoạn 3 (Tuần 7 - 10): Lắp ráp cơ khí, hiệu chỉnh góc lệch 0 độ (Offset Calibration) cho 18 động cơ Servo, lập trình thư viện nhúng trên Arduino Mega 2560.
  4. Giai đoạn 4 (Tuần 11 - 12): Thử nghiệm phối hợp các bước chân, đo đạc dòng tải tiêu thụ, hoàn thiện thuật toán tạo dáng đi và chuyển hướng.

Implementation và kết quả

Quy trình phát triển và chi tiết giải thuật

1. Thiết lập hệ tọa độ Denavit-Hartenberg (D-H)

Mỗi chân robot được mô hình hóa như một cánh tay máy 3 bậc tự do nối tiếp. Bảng thông số D-H cho từng chân robot được xác định như sau:

Khâu (Link $i$) Chiều dài khâu $a_i$ (mm) Góc xoắn $\alpha_i$ (độ) Độ lệch khâu $d_i$ (mm) Biến khớp $\theta_i$
1 (Coza) $a_1 = 25$ $-90^\circ$ 0 $\theta_1^*$
2 (Femur) $a_2 = 70$ $0^\circ$ 0 $\theta_2^*$
3 (Tibia) $a_3 = 65$ $0^\circ$ 0 $\theta_3^*$

Ma trận chuyển đổi thuần nhất tổng quát giữa hai khâu liên tiếp:

$$^{i-1}_i T = \begin{bmatrix} \cos\theta_i & -\sin\theta_i\cos\alpha_i & \sin\theta_i\sin\alpha_i & a_i\cos\theta_i \ \sin\theta_i & \cos\theta_i\cos\alpha_i & -\cos\theta_i\sin\alpha_i & a_i\sin\theta_i \ 0 & \sin\alpha_i & \cos\alpha_i & d_i \ 0 & 0 & 0 & 1 \end{bmatrix}$$

Nhân liên tiếp các ma trận chuyển đổi từ gốc chân đến điểm mút chân ($^0_3 T = ^0_1 T \times ^1_2 T \times ^2_3 T$), ta thu được hệ phương trình Động học thuận (FK) xác định tọa độ điểm cuối $P(P_x, P_y, P_z)$:

$$P_x = \cos(\theta_1) \cdot [a_1 + a_2\cos(\theta_2) + a_3\cos(\theta_2 + \theta_3)]$$

$$P_y = \sin(\theta_1) \cdot [a_1 + a_2\cos(\theta_2) + a_3\cos(\theta_2 + \theta_3)]$$

$$P_z = -a_2\sin(\theta_2) - a_3\sin(\theta_2 + \theta_3)$$

  Trục Z0 (Khớp 1)
     ^
     |      Link 1 (a1)
     +========+==============+ Link 2 (a2)
     |        |              \
   Thân     Khớp 2            \
   Robot                       \
                                + Khớp 3
                                 \
                                  \ Link 3 (a3)
                                   \
                                    v Điểm chạm đất P(Px, Py, Pz)

2. Giải thuật Động học nghịch (IK) và mã nguồn C++ trên Arduino

Để di chuyển điểm mút chân tới tọa độ mong muốn $P(P_x, P_y, P_z)$, thuật toán IK giải tích được cài đặt trực tiếp trên chip ATmega2560:

#include <Servo.h>

// Khai báo ma trận chân điều khiển 18 servo cho 6 cụm chân
// Thứ tự: [Chân 1 đến 6][Khớp 1, Khớp 2, Khớp 3]
const int servo_pin[6][3] = {
  {42, 43, 44}, // Chân 1 (Phải trước)
  {34, 35, 36}, // Chân 2 (Phải giữa)
  {26, 27, 28}, // Chân 3 (Phải sau)
  { 8,  9, 10}, // Chân 4 (Trái trước)
  {14, 15, 16}, // Chân 5 (Trái giữa)
  {18, 19, 20}  // Chân 6 (Trái sau)
};

Servo servo[6][3];
const float L1 = 25.0; // Chiều dài Coza (mm)
const float L2 = 70.0; // Chiều dài Femur (mm)
const float L3 = 65.0; // Chiều dài Tibia (mm)

float theta1, theta2, theta3;

// Hàm tính toán Động học nghịch (Inverse Kinematics)
void compute_IK(float x, float y, float z) {
  // 1. Tính góc quay khớp hông (Coza)
  theta1 = atan2(y, x);
  
  // 2. Tính khoảng cách chiếu và tọa độ phẳng tương đối
  float L = sqrt(sq(x) + sq(y));
  float nx = x * cos(theta1) - L1 + y * sin(theta1);
  float ny = -z;
  
  // 3. Tính góc khớp gối (Tibia) áp dụng định lý cosin
  float cos_theta3 = (sq(nx) + sq(ny) - sq(L2) - sq(L3)) / (2.0 * L2 * L3);
  // Ràng buộc điều kiện nghiệm thực
  cos_theta3 = constrain(cos_theta3, -1.0, 1.0);
  float sin_theta3 = sqrt(1.0 - sq(cos_theta3));
  theta3 = atan2(sin_theta3, cos_theta3);
  
  // 4. Tính góc khớp đùi (Femur)
  float beta_1 = atan2(L3 * sin(theta3), L2 + L3 * cos(theta3));
  float beta_2 = atan2(z, L - L1);
  float beta = beta_2 - beta_1;
  
  // Chuyển đổi Radian sang Degree
  theta1 = theta1 * 180.0 / PI;
  theta2 = beta * 180.0 / PI;
  theta3 = theta3 * 180.0 / PI;
}

3. Điều khiển tư thế thân giữa (Body Pose Rotation)

Robot thực hiện cân bằng hoặc nghiêng thân thông qua phép nhân tọa độ mút chân với ma trận quay Euler trong không gian 3 chiều:

  • Xoay quanh trục Roll (trục X) và Pitch (trục Y):

$$\begin{bmatrix} x' \ z' \end{bmatrix} = \begin{bmatrix} \cos(r) & -\sin(r) \ \sin(r) & \cos(r) \end{bmatrix} \begin{bmatrix} x \ z \end{bmatrix}$$

Tọa độ bù trừ cho chân tương ứng: $P_x' = P_x + (R - x')$, $P_z' = P_z + z'$.

  • Xoay quanh trục Yaw (trục Z - chuyển hướng di chuyển):

$$\begin{bmatrix} x' \ y' \end{bmatrix} = \begin{bmatrix} \cos(\text{yaw}) & -\sin(\text{yaw}) \ \sin(\text{yaw}) & \cos(\text{yaw}) \end{bmatrix} \begin{bmatrix} x \ y \end{bmatrix}$$

Thử nghiệm và Đánh giá hiệu năng

Hệ thống đã trải qua quá trình kiểm thử thực nghiệm với các bài đo tải trọng tĩnh và động học di chuyển:

+-------------------------------------------------------------------+
|               BIỂU ĐỒ BƯỚC CHÂN DÁNG ĐI TRIPOD GAIT               |
+-------------------------------------------------------------------+
| Chu kỳ (Phase) | Nhóm Chân A (Chân 0, 2, 4) | Nhóm Chân B (Chân 1, 3, 5) |
|----------------+----------------------------+---------------------|
| Giai đoạn 1    | Nhấc lên & Đưa tới (Swing) | Tì đất & Đẩy lùi (Stance) |
| Giai đoạn 2    | Hạ xuống chạm đất          | Hạ xuống chạm đất   |
| Giai đoạn 3    | Tì đất & Đẩy lùi (Stance)  | Nhấc lên & Đưa tới (Swing) |
| Giai đoạn 4    | Hạ chân hoàn tất chu kỳ    | Hạ chân hoàn tất    |
+-------------------------------------------------------------------+

Bảng thông số đo đạc thực nghiệm hệ thống

Đại lượng đo lường Giá trị thiết kế lý thuyết Kết quả thực nghiệm đạt được Mức độ sai lệch / Đánh giá
Thời gian tính toán IK (6 chân) $<15\text{ ms}$ $8.4\text{ ms}$ (trên ATmega2560 @ 16MHz) Đạt chuẩn thời gian thực
Dòng tiêu thụ ở trạng thái đứng yên $1.2\text{ A}$ $1.15\text{ A} - 1.35\text{ A}$ Hoạt động định mức
Dòng tiêu thụ đỉnh khi di chuyển tải $6.0\text{ A} - 8.0\text{ A}$ $7.2\text{ A}$ (Dưới ngưỡng 12A của Buck) Mạch Buck duy trì 5.1V ổn định
Tốc độ di chuyển lớn nhất (Tripod) $12\text{ cm/s}$ $9.6\text{ cm/s}$ Suy giảm do ma sát chân Mica
Tải trọng mang thêm tối đa (Payload) $1.5\text{ kg}$ $1.2\text{ kg}$ Khung Mica và khớp Servo an toàn

Đổi mới và đóng góp

Cải tiến kỹ thuật nổi bật

  1. Ứng dụng RC Servo Digital FR1501 thế hệ mới: Thay thế hoàn toàn các dòng servo analog phổ thông giá rẻ (MG995, MG996R) vốn thường xuyên bị rung giật (jitter), mất lực giữ khi ngừng băm xung dẫn đến sập khung robot bất ngờ. Động cơ Digital FR1501 tích hợp IC xử lý số, duy trì trạng thái xung điều khiển cuối cùng, lực kéo lớn đạt $17\text{ kg}\cdot\text{cm}$ với bánh răng kim loại chịu lực cao.
  2. Thuật toán IK tối ưu cho vi điều khiển 8-bit: Bằng việc đơn giản hóa hình học chân theo mặt phẳng 2D sau khi tách góc xoay hông $\theta_1$, thuật toán tính toán giải tích trực tiếp thông qua hàm atan2 chuẩn, loại bỏ nhu cầu tính định thức ma trận Jacobian phức tạp, giúp giảm thời gian chu kỳ quét xuống dưới $10\text{ ms}$.
+-------------------------------------------------------------------+
|               SO SÁNH ĐỘ ỔN ĐỊNH VÀ HIỆU SUẤT KHÓA KHỚP           |
+-------------------------------------------------------------------+
| 100% |======================== (FR1501 Digital - Đề tài: 96%)     |
|  75% |                                                            |
|  50% |================ (MG996R Analog: 62%)                       |
|  25% |========== (SG90 Micro: 35%)                                |
|   0% +------------------------------------------------------------+
|        Độ cứng vững và khả năng giữ vị trí khi mất xung tức thời  |
+-------------------------------------------------------------------+

Đóng góp thực tiễn vào lĩnh vực đào tạo và nghiên cứu

  • Đồ án cung cấp bộ tài liệu hoàn chỉnh từ file thiết kế cơ khí 3D (SolidWorks), sơ đồ kết nối điện tử đến mã nguồn C++ điều khiển nhúng cho cấu trúc Hexapod 18-DOF.
  • Làm tài liệu tham khảo cốt lõi cho sinh viên các ngành Kỹ thuật Điều khiển, Cơ điện tử và Tự động hóa trong việc tiếp cận lý thuyết Robot học Denavit-Hartenberg ứng dụng vào phần cứng vật lý.

Ứng dụng thực tế và triển khai

Kịch bản ứng dụng thực tế

  1. Trinh sát và thăm dò công nghiệp: Di chuyển luồn lách qua các đường ống dẫn khí, gầm cầu cảng hoặc khu vực rò rỉ hóa chất độc hại mà con người không thể tiếp cận trực tiếp.
  2. Hỗ trợ cứu hộ thiên tai: Vượt qua các đống đổ nát, gạch đá sau động đất để mang theo cảm biến nhiệt hoặc micro tìm kiếm nạn nhân còn sống sót.
  3. Mô hình giáo dục STEM và nghiên cứu chuyên sâu: Đóng vai trò là nền tảng phần cứng chuẩn để thử nghiệm các giải thuật trí tuệ nhân tạo (Reinforcement Learning) cho robot tự học bước đi.
+-------------------------------------------------------------------+
|                 LỘ TRÌNH TRIỂN KHAI VÀ NÂNG CẤP                   |
+-------------------------------------------------------------------+
| Giai đoạn 1 (Hiện tại):   Khung Mica + Arduino Mega + Tripod Gait  |
|                                     |                             |
|                                     v                             |
| Giai đoạn 2 (3-6 tháng):  Tích hợp IMU MPU6050 + Cân bằng tự động |
|                                     |                             |
|                                     v                             |
| Giai đoạn 3 (6-12 tháng): Nâng cấp Khung Nhôm CNC + ROS + Camera  |
+-------------------------------------------------------------------+

Bảng dự toán chi phí phần cứng (BOM)

STT Tên linh kiện / Thiết bị Thông số kỹ thuật Số lượng Đơn giá ước tính (VNĐ) Thành tiền (VNĐ)
1 Vi điều khiển Arduino Mega ATmega2560 R3 16MHz 1 250,000 250,000
2 Shield Mega Sensor V2.0 Kết nối 54 I/O chân cắm 1 80,000 80,000
3 Động cơ Servo Digital FR1501 $17\text{ kg}\cdot\text{cm}$, Bánh răng kim loại 18 150,000 2,700,000
4 Pin Lithium Polymer (LiPo) 3S 11.1V 2200mAh 30C 1 350,000 350,000
5 Mạch giảm áp DC-DC Buck Vin 4.5-30V, Vout 5V 12A 1 120,000 120,000
6 Khung thân & chi tiết cơ khí Mica đen 3mm cắt laser, ốc vít M3 1 bộ 300,000 300,000
Tổng Toàn bộ hệ thống phần cứng 3,800,000

Hạn chế và hướng phát triển

Hạn chế kỹ thuật hiện tại

  • Hệ thống điều khiển vòng hở (Open-Loop): Chưa tích hợp cảm biến đo góc nghiêng (IMU) hoặc cảm biến lực chạm đất ở mút chân, dẫn đến robot chưa thể tự điều chỉnh góc nghiêng khi gặp bề mặt nghiêng bất ngờ.
  • Vật liệu cơ khí: Vật liệu Mica 3mm có độ giòn tương đối cao, khi hoạt động liên tục ở tải trọng nặng dễ phát sinh độ rơ tại các lỗ bắt vít của ngàm servo.
  • Không gian chuyển động: Chưa hoàn thiện quỹ đạo di chuyển đường cong thích nghi động và di chuyển đa hướng tức thời trên địa hình bậc thang dốc.

Hướng phát triển trong tương lai

  1. Nâng cấp cảm biến phản hồi: Tích hợp module cảm biến quán tính 6 trục IMU MPU-6050 kết hợp thuật toán bộ lọc Kalman để robot tự động bù nghiêng thân khi di chuyển qua dốc.
  2. Chuyển đổi vật liệu cơ khí: Nâng cấp khung thân sang vật liệu sợi Carbon (Carbon Fiber) hoặc Hợp kim nhôm 6061 cắt CNC giúp giảm 40% trọng lượng và tăng gấp 3 lần độ cứng vững.
  3. Nâng cấp kiến trúc xử lý: Giao tiếp Arduino Mega với máy tính đơn bo Raspberry Pi 4 chạy hệ điều hành robot ROS (Robot Operating System), tích hợp Camera Slam quét bản đồ môi trường 3D theo thời gian thực.

Đối tượng hưởng lợi

+--------------------------------------------------------------------------+
|                        CÁC NHÓM ĐỐI TƯỢNG HƯỞNG LỢI                      |
+--------------------------------------------------------------------------+
|                                                                          |
|  [SINH VIÊN & HỌC VIÊN]             [KỸ SƯ NHÚNG / TỰ ĐỘNG HÓA]          |
|  - Nắm vững toán học D-H thực chiến  - Template code điều khiển 18 Servo |
|  - Làm chủ thiết kế SolidWorks       - Sơ đồ phân phối nguồn công suất   |
|  -> Giảm 60% thời gian làm đồ án     -> Rút ngắn chu kỳ R&D phần cứng    |
|                                                                          |
|  [DOANH NGHIỆP R&D ROBOTICS]        [CỘNG ĐỒNG NGIÊN CỨU STEM]          |
|  - Nền tảng kiểm thử giá rẻ (<4tr)  - Nguồn học liệu mở chuẩn hóa       |
|  - Tiềm năng phát triển AGV đặc chủng - Thúc đẩy phong trào Robotics      |
+--------------------------------------------------------------------------+
  • Sinh viên ngành Kỹ thuật Điều khiển, Điện tử, Cơ điện tử: Tiếp cận phương pháp thiết lập bảng thông số D-H và giải bài toán động học nghịch một cách trực quan, có thể triển khai thực nghiệm ngay trên mô hình thực tế.
  • Kỹ sư lập trình nhúng: Nắm bắt kỹ thuật đồng bộ hóa xung PWM số lượng lớn trên vi điều khiển AVR, giải quyết bài toán chống sụt áp và tối ưu hóa bộ nhớ SRAM khi xử lý toán học thực nghiệm.
  • Các đơn vị phát triển robot dịch vụ: Sở hữu mô hình tham chiếu phần cứng giá rẻ (dưới 4 triệu đồng) để phát triển các sản phẩm robot giám sát công nghiệp quy mô nhỏ.

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

1. Yêu cầu kỹ thuật tối thiểu để triển khai và nạp code cho hệ thống là gì?

Cần máy tính cài đặt phần mềm Arduino IDE v1.8.x trở lên, cáp kết nối USB Type-B nối với Arduino Mega 2560. Nguồn điện yêu cầu Pin LiPo tối thiểu 2S (7.4V) hoặc 3S (11.1V) với dòng xả tối thiểu 20C, kết nối qua mạch hạ áp Buck điều chỉnh điện áp ra chính xác $5.2\text{V} - 6.0\text{V}$ cấp cho chân nguồn của Sensor Shield.

2. Tại sao lại chọn Arduino Mega 2560 thay vì Arduino Uno R3?

Arduino Uno R3 chỉ có 6 chân hỗ trợ xuất xung PWM phần cứng và bộ nhớ SRAM giới hạn $2\text{ KB}$, không đủ số chân để điều khiển độc lập 18 động cơ Servo (mỗi chân 3 động cơ). Arduino Mega 2560 sở hữu vi điều khiển ATmega2560 với 54 chân Digital I/O, bộ nhớ SRAM $8\text{ KB}$ và 4 bộ phần cứng định thời (Timers), cho phép điều khiển mượt mà toàn bộ 18 Servo cùng lúc thông qua thư viện <Servo.h>.

3. Làm thế nào để giải quyết hiện tượng vi điều khiển bị Reset (Brown-out Reset) khi 18 servo cùng quay?

Hiện tượng sụt áp xảy ra do dòng khởi động tức thời của 18 servo có thể vượt quá $8\text{A}$. Giải pháp là tách rời hoàn toàn đường nguồn: Pin LiPo cấp trực tiếp vào mạch Buck DC-DC 12A để hạ áp xuống 5.5V nuôi riêng dàn Servo qua cọc nguồn ngoài trên Sensor Shield. Arduino Mega được cấp nguồn riêng hoặc qua ngõ ra phụ, đồng thời nối chung đường mass (GND) giữa mạch công suất và vi điều khiển.

4. Động cơ Digital RC Servo FR1501 có ưu điểm gì vượt trội so với Servo Analog MG996R?

FR1501 là dòng servo kỹ thuật số (Digital Servo) có tần số lấy mẫu và cập nhật vị trí cao hơn gấp nhiều lần so với Analog Servo. Điều này giúp loại bỏ hoàn toàn độ trễ, triệt tiêu hiện tượng rung lắc ở vị trí cân bằng, đồng thời chip tích hợp có tính năng giữ nguyên trạng thái góc quay gần nhất khi tín hiệu điều khiển bị gián đoạn, ngăn chặn hiện tượng khung robot bị sập gãy.

5. Chi phí chế tạo toàn bộ robot nhện 6 chân này là bao nhiêu và mất bao lâu để hoàn thành?

Tổng chi phí linh kiện phần cứng dao động từ $3.500.000\text{ VNĐ}$ đến $4.000.000\text{ VNĐ}$ (trong đó 18 động cơ Servo chiếm khoảng 70% chi phí). Thời gian gia công cơ khí, lắp ráp và căn chỉnh góc lệch 0 độ cho động cơ kéo dài từ 2 đến 3 tuần đối với nhóm nghiên cứu từ 2 người.

Kết luận

Đồ án tốt nghiệp "Thiết kế, thi công và lập trình điều khiển Robot nhện 6 chân" đã giải quyết toàn diện chuỗi mắt xích từ nghiên cứu lý thuyết động học nhiều bậc tự do, thiết kế cơ khí 3D trên SolidWorks, tính toán giải thuật FK/IK giải tích, đến thi công hoàn thiện mô hình cơ điện tử thực tế. Việc kết hợp vi điều khiển Arduino Mega 2560, Shield mở rộng cảm biến và 18 động cơ Digital RC Servo FR1501 mang lại độ tin cậy vận hành vượt trội, đảm bảo robot di chuyển ổn định theo các dáng đi Tripod Gait và Wave Gait. Đây là nền tảng thực nghiệm vững chắc mở ra tiềm năng ứng dụng to lớn trong công tác cứu hộ, khảo sát địa hình phức tạp và giảng dạy kỹ thuật robot chuyên sâu.