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

Sự phát triển của công nghệ tự động hóa và robot công nghiệp đã đạt nhiều bước tiến quan trọng; theo thống kê của Hiệp hội Robot Quốc tế (IFR) năm 2022, các quốc gia châu Á chiếm khoảng 74% tổng số lượng robot công nghiệp được lắp đặt trên toàn thế giới. Tại Việt Nam, cánh tay robot đã và đang được triển khai phổ biến trong công nghiệp sản xuất ô tô (VinFast, THACO), giáo dục đào tạo (Đại học Sư phạm Kỹ thuật TP.HCM, Đại học Bách khoa TP.HCM) và y tế (Bệnh viện Trung ương Quân đội 108). Tuy nhiên, phần lớn các đơn vị trong nước mới tiếp cận ở mức độ vận hành thiết bị thương mại mà chưa hoàn toàn làm chủ công nghệ điều khiển cốt lõi.

Trong lĩnh vực y tế cộng đồng, số liệu năm 2022 của Bộ Y tế Việt Nam cho thấy mỗi năm có khoảng 200.000 ca đột quỵ, dẫn đến nhu cầu rất lớn về điều trị và tập luyện phục hồi chức năng vận động. Tình trạng thiếu hụt nhân lực và cơ sở vật chất trị liệu chuyên sâu thúc đẩy việc nghiên cứu các hệ thống robot khung xương trợ lực (Exoskeleton). So với robot công nghiệp truyền thống (như PUMA 560 hay UR3), robot Exoskeleton chi trên mô phỏng trực tiếp chuyển động cơ sinh học của cánh tay người, cho phép tương tác trực tiếp qua giao diện người - máy (HMI). Mặc dù đã có các công trình trong nước tiếp cận thiết bị phục hồi chức năng chi trên (như mô hình 3 bậc tự do của Thang Cao Nguyen năm 2020, quy hoạch quỹ đạo DMP năm 2022, hay robot khung xương RAUPEX năm 2023), việc nghiên cứu mô hình khung xương 6 bậc tự do kết hợp điều khiển chuyển động thông qua tín hiệu điện cơ bề mặt (sEMG/EMGs) vẫn còn nhiều hạn chế.

Đề tài "Thiết kế bộ điều khiển chuyển động cho robot 6 bậc tự do và sử dụng tín hiệu điện cơ" do sinh viên Nguyễn Minh Nhựt và Vũ Công Dương thực hiện dưới sự hướng dẫn của TS. Trần Đức Thiện tại Trường Đại học Sư phạm Kỹ thuật TP.HCM đặt ra các mục tiêu cụ thể:

  1. Tính toán động học thuận và động học nghịch cho robot Exoskeleton 6 bậc tự do.
  2. Điều khiển chuyển động cho cánh tay robot theo quỹ đạo xác định.
  3. Thiết kế, thi công module và xây dựng mạng truyền thông CAN bus phân tán gồm 7 node.
  4. Đo đạc và xử lý triệt để nhiễu trên cảm biến điện cơ EMGs.
  5. Ứng dụng bộ lọc Kalman để chuyển đổi và ước lượng tín hiệu EMGs thành góc quay khớp, từ đó điều khiển 01 khớp thực tế của robot.

Đối tượng nghiên cứu là hệ thống cánh tay robot Exoskeleton 6 bậc tự do có sẵn tại phòng thí nghiệm Robot và Điều khiển thông minh (RICLAB), mạng truyền thông công nghiệp CAN bus, và cảm biến điện cơ cực khô gắn trên các bó cơ chi trên của người kết hợp cảm biến định hướng IMU làm tín hiệu tham chiếu. Phạm vi không gian nghiên cứu giới hạn tại phòng thí nghiệm RICLAB thuộc Khoa Điện - Điện tử, Trường Đại học Sư phạm Kỹ thuật TP.HCM; phạm vi thời gian thực hiện từ ngày 10/02/2024 đến ngày 21/06/2024.

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

Đồ án xây dựng khung lý thuyết dựa trên các trụ cột toán học động học robot, lý thuyết truyền thông mạng công nghiệp và kỹ thuật xử lý tín hiệu y sinh:

Thành phần lý thuyết Công cụ / Mô hình toán học áp dụng Mục đích kỹ thuật
Động học thuận Phương pháp Modified Denavit-Hartenberg (DH cải tiến) Xác định vị trí và hướng của cơ cấu chấp hành cuối thông qua ma trận chuyển vị thuần nhất tổng quát $T_i^{i-1}$
Động học nghịch Ma trận Jacobian hình học kết hợp Damped Least Squares (DLS) Giải bài toán nghịch đảo tránh kỳ dị thông qua công thức $J^* = J^T(JJ^T + \lambda^2 I)^{-1}$ với hệ số giảm chấn $\lambda$
Tối ưu hóa ràng buộc khớp Thuật toán suy giảm độ dốc (Gradient Descent) với hàm thế năng $H(q)$ Tận dụng không gian rỗng $(I - J^+J)$ để giữ biến khớp nằm trong khoảng dịch chuyển cho phép
Quy hoạch quỹ đạo Đa thức bậc 5 (Quintic Polynomial) trong không gian khớp Đảm bảo tính liên tục, mượt mà của quỹ đạo về vị trí, vận tốc và gia tốc
Mạng truyền thông Chuẩn giao tiếp CAN bus 2.0 (ISO 11898) với 2 dây vi sai CAN_H, CAN_L Truyền nhận dữ liệu điều khiển phân tán thời gian thực tốc độ cao giữa Master và các Slave
Xử lý tín hiệu điện cơ Biến đổi Fourier rời rạc (DFT), lọc số Butterworth, bộ lọc Kalman Phân tích miền tần số, lọc dải thông 20-500 Hz và ước lượng góc khớp chuyển động

Về mặt phương pháp nghiên cứu, tác giả kết hợp ba phương pháp chính:

  • Phương pháp phân tích lý thuyết: Thiết lập mô hình toán học giải tích cho hệ 6 bậc tự do; giải quyết bài toán kỳ dị của ma trận Jacobian thông qua phương pháp bình phương tối thiểu giảm chấn (DLS) và thuật toán Gradient Descent; tính toán các hệ số đa thức quỹ đạo từ điều kiện biên vị trí, vận tốc và gia tốc ban đầu/kết thúc.
  • Phương pháp mô phỏng số: Sử dụng phần mềm MATLAB 2019b và công cụ Simscape/Simulink để mô phỏng kiểm chứng giải thuật động học, quét và vẽ không gian làm việc 3D (toàn phần và giới hạn) của cơ cấu cuối, đánh giá sai số bám quỹ đạo và đáp ứng moment của từng khớp.
  • Phương pháp thực nghiệm - kiểm chứng: Thiết kế bo mạch phần cứng, thi công tủ điện thực tế; đo đạc số xung phản hồi từ bộ mã hóa xung (Encoder) của động cơ AC Servo và động cơ bước Step Motor qua mạng CAN; thu thập dữ liệu EMG thô từ cơ nhị đầu (Biceps) và cơ tam đầu (Triceps), xử lý lọc số và so sánh góc ước lượng với cảm biến góc IMU bằng chỉ số sai số bình phương trung bình (RMSE).

Thiết kế và triển khai

Hệ thống điều khiển được thiết kế theo cấu trúc phần cứng và phần mềm phân tán nhằm đảm bảo tính ổn định và tính mở rộng cao cho robot Exoskeleton 6 bậc tự do:

[Máy tính nhúng / Master]
          |
     (Mạng CAN bus 2 dây: CAN_H, CAN_L - 1 Mbps)
          |
  +-------+-------+-------+-------+-------+-------+
  |       |       |       |       |       |       |
[Node 1] [Node 2] [Node 3] [Node 4] [Node 5] [Node 6]
(Khớp 1) (Khớp 2) (Khớp 3) (Khớp 4) (Khớp 5) (Khớp 6)
  |       |       |       |       |       |       |
[AC S.]  [AC S.]  [AC S.]  [Step]  [Step]  [Step]

Về phần cứng và mạng truyền thông, hệ thống gồm 1 khối Master (đóng vai trò điều phối, tính toán động học và gửi lệnh quỹ đạo) và 6 khối Slave (tương ứng với 6 khớp của cánh tay robot):

  • Mạch Slave PCB tự thiết kế: Tích hợp vi điều khiển trung tâm xử lý cục bộ; IC điều khiển và thu phát CAN bus chuyên dụng kết nối với bus truyền thông chung; mạch cách ly và chuyển đổi tín hiệu RS485 sang UART; khối mạch chuyển đổi mức logic để đọc tín hiệu Encoder vi sai từ động cơ AC Servo; mạch tạo dao động thạch anh ngoại; các tầng hạ áp xung tạo nguồn 5VDC và 3.3VDC công suất thấp cấp cho vi mạch.
  • Tủ điện điều khiển động lực: Bố trí các bộ nguồn biến đổi công nghiệp, hệ thống cầu chì, rơ le bảo vệ, 3 bộ Driver điều khiển động cơ AC Servo công suất lớn (cho các khớp gốc chịu tải cao) và 3 bộ Driver TB6600 điều khiển động cơ bước Step Motor (cho các khớp chấp hành phía ngọn), kèm hệ thống cầu đấu dây tín hiệu riêng biệt nhằm chống nhiễu chéo giữa mạch động lực và mạch điều khiển.
  • Mạng CAN 7 node: Cấu hình chuẩn CAN 2.0A với khung truyền 11-bit ID tiêu chuẩn; tốc độ truyền dữ liệu thiết lập lên tới 1 Mbps. Dữ liệu gói tin gồm trường điều khiển DLC tối đa 8 byte, chứa các giá trị đặt vị trí, vận tốc và cờ trạng thái; áp dụng bộ lọc phần cứng (Filter CAN) tại từng node để phân tách luồng dữ liệu độc lập hoặc đồng thời.

Về phần mềm điều khiển và giao diện người dùng, nhóm tác giả triển khai giao diện giám sát HMI đa chức năng bằng Qt Creator chạy trên nền tảng hệ điều hành Ubuntu Linux. Giao diện được cấu trúc thành các thẻ chức năng độc lập:

  • Giới thiệu (Introduce): Hiển thị thông số tổng quan của hệ thống và trạng thái kết nối phần cứng.
  • Cài đặt kết nối: Cấu hình cổng giao tiếp, tốc độ baud và nhận diện các node mạng CAN đang hoạt động.
  • Chế độ Jog và Set Home: Cho phép vận hành từng khớp riêng lẻ bằng tay để căn chỉnh cơ khí và xác định vị trí gốc (Home) của toàn bộ 6 trục.
  • Chạy bài tập phục hồi: Nạp các tọa độ điểm nút của bài tập trị liệu, tự động tính toán quy hoạch quỹ đạo đa thức bậc 5 và truyền lệnh đồng bộ xuống các khớp.
  • Điều khiển bằng tín hiệu EMGs: Thu nhận trực tiếp dữ liệu điện cơ từ cảm biến cực khô DFMotion Robot, hiển thị đồ thị điện áp cơ theo thời gian thực, thực thi bộ lọc số Butterworth dải thông kết hợp bộ lọc Kalman để ước lượng góc co duỗi khớp khuỷu tay và điều khiển bám vị trí cho khớp tương ứng.

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

Chương 1: Tổng quan

Chương 1 phân tích bối cảnh phát triển của robot công nghiệp và robot phục hồi chức năng trên thế giới và tại Việt Nam. Tác giả tổng hợp số liệu của IFR (châu Á chiếm 74% robot công nghiệp năm 2022) và thống kê của Bộ Y tế Việt Nam về 200.000 bệnh nhân đột quỵ hàng năm. Nội dung đi sâu phân loại các kết cấu robot Exoskeleton (dẫn động trực tiếp và dẫn động bằng dây cáp), khảo cứu các công trình nghiên cứu sử dụng tín hiệu EMG trong điều khiển trợ lực ngoài nước và các đề tài nghiên cứu khung xương bàn tay, cánh tay tại Đại học Sư phạm Kỹ thuật TP.HCM. Từ đó, chương xác định mục tiêu thiết kế bộ điều khiển cho robot Exoskeleton 6 bậc tự do, xây dựng module CAN bus và xử lý tín hiệu EMGs để điều khiển 01 khớp, đồng thời nêu rõ các giới hạn về mô hình cơ khí có sẵn và điều khiển vòng hở.

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

Chương này thiết lập toàn bộ nền tảng toán học và kỹ thuật cho đồ án:

  • Trình bày phương pháp đặt trục tọa độ theo quy tắc Denavit-Hartenberg cải tiến (Modified DH) và ma trận biến đổi thuần nhất $4 \times 4$.
  • Phân tích vận tốc dài và vận tốc góc giữa hai hệ trục liền kề, xây dựng ma trận Jacobian hình học $6 \times n$.
  • So sánh các phương pháp giải động học nghịch: Jacobian Transpose, Pseudo-Inverse, phương pháp Damped Least Squares (DLS) với hệ số giảm chấn $\lambda$ nhằm khắc phục điểm kỳ dị, và phương pháp Gradient Descent kết hợp hàm mục tiêu Homogeneous $H(q)$ để ràng buộc hành trình góc khớp.
  • Xây dựng thuật toán quy hoạch quỹ đạo điểm - điểm theo đa thức bậc 5 trong không gian khớp với 6 hệ số $a_0$ đến $a_5$ giải từ hệ phương trình điều kiện biên vị trí, vận tốc và gia tốc.
  • Tổng quan chuẩn truyền thông CAN bus 2.0, cấu trúc khung truyền dữ liệu (Identifier, RTR, IDE, DLC, Data Field 0-8 bytes, CRC 16 bits, ACK 2 bits).
  • Cơ chế phát sinh tín hiệu điện cơ từ hệ thần kinh trung ương đến các đơn vị vận động cơ (Motor Unit), đặc tính tín hiệu EMG (biên độ 0-10 mV đỉnh-đỉnh, dải tần 0-500 Hz, dải thông tin vận động 20-500 Hz).
  • Lý thuyết xử lý tín hiệu trong miền thời gian và miền tần số qua biến đổi Fourier rời rạc (DFT), các bước thiết kế bộ lọc tích cực số Butterworth (thông thấp, thông cao) và giải thuật lọc Kalman ước lượng trạng thái.

Chương 3: Thiết kế và thi công hệ thống

Chương 3 trình bày chi tiết quá trình chế tạo phần cứng:

  • Thiết kế sơ đồ khối toàn hệ thống gồm khối Master và 6 khối Slave.
  • Thiết kế sơ đồ nguyên lý và layout mạch in (PCB) cho các module CAN Slave: khối nguồn hạ áp 5V và 3.3VDC, khối vi điều khiển trung tâm, module chuyển đổi RS485 sang UART, module giao tiếp CAN bus, khối đọc tín hiệu Encoder vi sai và mạch nạp USB.
  • Xây dựng kiến trúc mạng CAN 7 node: thiết lập chế độ gửi lệnh đơn địa chỉ và gửi đồng thời (broadcast), cấu hình bảng lọc địa chỉ (Filter CAN), định nghĩa cấu trúc gói tin 2 chiều và lưu đồ giải thuật ngắt định thời lấy mẫu.
  • Thi công tủ điện điều khiển hoàn chỉnh: lắp đặt các bộ nguồn, aptomat, 3 Driver AC Servo, 3 Driver Step Motor TB6600, thiết lập sơ đồ đi dây động lực và sơ đồ kết nối tín hiệu điều khiển.
  • Thiết kế giao diện phần mềm HMI trên Qt Creator (Ubuntu OS) với 5 cửa sổ chức năng: Introduce, Cài đặt kết nối, Chạy Jog/Set Home, Chạy bài tập và Điều khiển bằng EMGs.

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

Chương 4 tập trung vào mô hình toán học cụ thể của cánh tay robot Exoskeleton 6 bậc tự do:

  • Thiết lập hệ trục tọa độ không gian trên từng khâu khớp theo Modified DH.
  • Xây dựng bảng thông số DH cải tiến và xác định giới hạn góc quay vật lý của từng khớp.
  • Thiết lập các ma trận biến đổi thuần nhất thành phần $T_1^0, T_2^1, \dots, T_6^5$ và tính toán ma trận tổng hợp $T_6^0$, tách thành ma trận hướng $R_{3 \times 3}$ và vector vị trí cơ cấu cuối $P_{3 \times 1}$.
  • Triển khai phương pháp giải động học nghịch bằng giải tích và phương pháp ma trận Jacobian có định hướng kết hợp DLS và Gradient Descent.

Chương 5: Xây dựng bộ điều khiển cảm biến EMGs

Chương này hiện thực hóa kênh điều khiển sinh học:

  • Xác định vị trí dán điện cực cảm biến cực khô DFMotion Robot dựa trên giải phẫu cơ thể: điện cực đo gắn trên cơ nhị đầu (Biceps brachii) tại vị trí 1/3 khoảng cách từ trục khớp khuỷu đến xương đòn, điện cực tham chiếu gắn tại cổ tay.
  • Thu thập dữ liệu tín hiệu điện cơ thô trong các chuyển động co duỗi cẳng tay.
  • Thực hiện biến đổi phổ tần số Fourier (FFT) để nhận diện các thành phần nhiễu nguồn và nhiễu chuyển động tần số thấp.
  • Thiết kế bộ lọc số Butterworth dải thông (kết hợp thông cao và thông thấp) loại bỏ triệt để nhiễu ngoài dải 20-500 Hz.
  • Xây dựng thuật toán lọc Kalman tích hợp dữ liệu góc tham chiếu từ cảm biến IMU để chuyển đổi năng lượng co cơ thành góc quay ước lượng của khớp khuỷu tay.

Chương 6: Mô phỏng và đánh giá hệ thống

Chương 6 trình bày các kết quả kiểm chứng trên môi trường MATLAB/Simulink:

  • Xây dựng mô hình hình học và vật lý của robot trong công cụ Simscape Multibody.
  • Kiểm chứng động học nghịch Jacobian: cho cơ cấu cuối di chuyển đến các điểm tọa độ kiểm tra bất kỳ, so sánh sai số giữa vị trí đặt và vị trí đạt được.
  • Quét không gian làm việc 3D của robot: biểu diễn đồ thị không gian làm việc tổng quát toàn phần và không gian làm việc bị giới hạn theo góc nhìn Oxy và Oxz.
  • Mô phỏng quy hoạch quỹ đạo điểm - điểm: phân tích đáp ứng quỹ đạo 3D, sự biến thiên vị trí, vận tốc, gia tốc theo các trục X, Y, Z, sai số giữa quỹ đạo lý tưởng và quỹ đạo khớp, đồng thời trích xuất đáp ứng moment tải (Torque) của cả 6 khớp.
  • Mô phỏng xử lý tín hiệu EMGs: nạp tập dữ liệu thu thập từ cơ Biceps và Triceps, đánh giá đáp ứng tín hiệu trước và sau khi qua bộ lọc số, kiểm chứng sự bám sát giữa góc ước lượng Kalman từ EMG và góc đo thực tế từ cảm biến IMU.

Chương 7: Thực nghiệm và đánh giá hệ thống

Chương 7 đánh giá mô hình thực tế qua các bài đo kiểm định lượng:

  • Cấu hình thông số dòng điện, vi bước trên Driver Step TB6600 và cài đặt thông số điều khiển vị trí trên phần mềm Driver AC Servo.
  • Thực nghiệm mạng truyền thông CAN bus: kiểm tra phản hồi số xung encoder của Driver AC Servo khi điều khiển quay góc nhỏ 0.2 độ và quay về vị trí ban đầu; kiểm tra độ tin cậy gửi nhận 5 lần giữa hai giá trị bất kỳ.
  • Thực nghiệm quy hoạch quỹ đạo cánh tay thực tế: đo đạc tọa độ khớp khuỷu tay chuyển động trong không gian 3 chiều, so sánh đáp ứng thực tế với mô phỏng về vị trí, hướng và gia tốc theo các trục X, Y, Z; tính toán chỉ số sai số bình phương trung bình (RMSE).
  • Thực nghiệm điều khiển robot bằng cảm biến EMGs: gắn cảm biến lên người thử nghiệm, đọc tín hiệu co duỗi cơ thời gian thực, lọc và ước lượng góc khớp qua bộ lọc Kalman, truyền lệnh qua mạng CAN để điều khiển khớp khuỷu tay của robot bám theo cử động cánh tay người.

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

Chương 8 tổng kết các kết quả đạt được về phần cứng (tủ điện, mạch PCB CAN Slave), phần mềm (thuật toán động học DLS, giao diện Qt Creator) và kênh điều khiển EMGs. Đồng thời, chương chỉ ra các hướng phát triển tiếp theo như bổ sung cơ chế điều khiển lực kín, nâng cấp cảm biến đa kênh và thử nghiệm lâm sàng trên đối tượng cần phục hồi chức năng.

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

Đồ án đã chế tạo và vận hành thành công mô hình thực nghiệm hệ thống điều khiển chuyển động cho robot Exoskeleton 6 bậc tự do và kênh điều khiển sinh học EMGs với các kết quả cụ thể:

Hạng mục đánh giá Kết quả đạt được trong nghiên cứu
Mạng truyền thông CAN bus 7 node Giao tiếp thời gian thực ổn định ở tốc độ cao (lên đến 1 Mbps); truyền nhận dữ liệu chính xác 100% trong các bài thử nghiệm gửi nhận 5 chu kỳ liên tiếp; bộ điều khiển đọc chính xác phản hồi xung Encoder của Driver AC Servo ở góc dịch chuyển nhỏ $0.2^\circ$ và trở về gốc tọa độ
Giải thuật động học nghịch DLS & Gradient Descent Khắc phục được hiện tượng không khả nghịch tại các điểm kỳ dị; tính toán hội tụ nghiệm góc khớp mượt mà; giữ chuyển động của 6 khớp nằm trọn trong giới hạn cơ khí cho phép
Quy hoạch quỹ đạo không gian khớp Quỹ đạo đa thức bậc 5 giúp cánh tay robot chuyển động êm ái, liên tục về vận tốc và gia tốc; sai số chuyển động giữa mô phỏng và thực nghiệm được đánh giá định lượng qua sai số bình phương trung bình (RMSE) trên các trục tọa độ X, Y, Z
Xử lý tín hiệu điện cơ EMGs Bộ lọc số Butterworth dải thông 20-500 Hz loại bỏ thành công nhiễu trôi đường nền và nhiễu hài; thuật toán lọc Kalman ước lượng góc khớp khuỷu tay bám sát tín hiệu góc tham chiếu từ cảm biến IMU trong các chuyển động co/duỗi cơ Biceps và Triceps

Về mặt giải pháp kỹ thuật, đồ án đóng góp một kiến trúc điều khiển phân tán qua mạng CAN bus sử dụng các bo mạch Slave tự thiết kế, giúp giảm đáng kể số lượng dây dẫn chạy dọc thân khung xương robot so với phương pháp điều khiển tập trung truyền thống. Đề tài cũng hoàn thiện quy trình từ mô phỏng thuật toán trên MATLAB/Simscape đến triển khai nhúng trên phần cứng thực tế và xây dựng giao diện vận hành trực quan trên hệ điều hành nguồn mở Ubuntu Linux.

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

Theo công bố của nhóm tác giả, công trình còn tồn tại một số hạn chế do điều kiện nghiên cứu:

  • Đề tài chỉ sử dụng khung cơ khí robot Exoskeleton có sẵn tại phòng thí nghiệm, chưa can thiệp cải tiến hoặc tối ưu hóa kết cấu cơ khí.
  • Hệ thống mới dừng lại ở cấu trúc điều khiển vị trí vòng hở (Open-loop) qua mạng CAN, chưa tích hợp vòng hồi tiếp lực/moment tương tác trực tiếp giữa người dùng và robot.
  • Chưa kiểm định độ ổn định và an toàn công nghiệp khi hệ thống mang tải nặng trong quá trình vận hành liên tục.
  • Quỹ đạo chuyển động thực nghiệm mới được kiểm chứng trên một mẫu bài tập phục hồi chức năng dạng điểm - điểm cơ bản.
  • Kênh đo tín hiệu sinh học mới sử dụng 01 cảm biến EMGs cực khô đơn lẻ đặt trên cơ tay, chưa mở rộng ra cụm cơ đa kênh; phương pháp dò tìm hệ số bộ lọc số và bộ lọc Kalman vẫn thực hiện thủ công dựa trên kinh nghiệm.

Hướng phát triển tiếp theo được đề xuất bao gồm:

  • Nghiên cứu và thiết kế bộ điều khiển trở kháng (Impedance Control) hoặc điều khiển lực bám để đảm bảo tính an toàn cao khi người bệnh tương tác trực tiếp với robot.
  • Tự động hóa quá trình tối ưu hệ số của bộ lọc Kalman và giải thuật Jacobian bằng các thuật toán thông minh.
  • Mở rộng hệ thống cảm biến EMGs đa kênh, áp dụng các kỹ thuật học máy (Machine Learning) hoặc mạng nơ-ron học sâu (Deep Learning) để nhận dạng nhiều dạng cử động phức tạp của toàn bộ cánh tay.
  • Nâng cấp phần cứng, bổ sung các cơ cấu ngắt khẩn cấp phần cứng đạt chuẩn y tế và tiến hành thử nghiệm lâm sàng trên các bệnh nhân suy giảm chức năng vận động.

Giá trị tham khảo

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

Tài liệu có giá trị ứng dụng thực tiễn cao ở các phần:

  • Phương pháp xây dựng thuật toán động học nghịch Jacobian kết hợp Damped Least Squares và Gradient Descent để xử lý bài toán kỳ dị cho robot cánh tay/khung xương 6 bậc tự do.
  • Quy trình thiết kế phần cứng bo mạch vi điều khiển giao tiếp mạng CAN bus phân tán, sơ đồ đấu nối tủ điện điều khiển phối hợp giữa động cơ AC Servo và Step Motor.
  • Kỹ thuật lọc số dải thông Butterworth và thuật toán ước lượng trạng thái Kalman trong chuyển đổi tín hiệu điện cơ y sinh (EMGs) sang biến góc khớp phục vụ điều khiển chuyển động trực quan.

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

1. Đề tài giải quyết vấn đề điểm kỳ dị trong bài toán động học nghịch của robot 6 bậc tự do bằng phương pháp nào?

Tác giả sử dụng phương pháp ma trận Jacobian nghịch đảo theo thuật toán bình phương tối thiểu giảm chấn (Damped Least Squares - DLS) thông qua công thức $J^* = J^T(JJ^T + \lambda^2 I)^{-1}$. Hệ số giảm chấn $\lambda$ giúp hạn chế độ nhạy cảm của ma trận tại các điểm kỳ dị hoặc gần kỳ dị. Đồng thời, thuật toán suy giảm độ dốc (Gradient Descent) được kết hợp với hàm thế năng Homogeneous $H(q)$ để chiếu các nghiệm vào không gian rỗng $(I - J^+J)$, giúp ràng buộc các góc quay của 6 khớp luôn nằm trong giới hạn chuyển động cơ khí an toàn.

2. Cấu trúc mạng truyền thông CAN bus được thiết kế và vận hành như thế nào?

Mạng truyền thông của hệ thống gồm 7 node (1 Master Module và 6 Slave Module) kết nối qua 2 dây vi sai CAN_H và CAN_L theo chuẩn CAN 2.0A, tốc độ truyền dữ liệu đạt 1 Mbps. Master Module chịu trách nhiệm tính toán và gửi dữ liệu đặt quỹ đạo; mỗi Slave Module quản lý một khớp robot riêng biệt (3 khớp gốc dùng AC Servo và 3 khớp sau dùng Step Motor TB6600). Hệ thống hỗ trợ cả chế độ gửi dữ liệu đơn địa chỉ lẫn gửi đồng thời toàn mạng thông qua cấu hình bộ lọc Filter CAN phần cứng.

3. Cảm biến điện cơ EMGs được đặt tại vị trí nào và dùng để điều khiển khớp nào trên robot?

Nhóm tác giả sử dụng 01 cảm biến EMGs cực khô (DFMotion Robot) gắn trực tiếp lên da tại bó cơ nhị đầu (Biceps brachii) ở vị trí 1/3 khoảng cách tính từ trục khớp khuỷu tay đến xương đòn trước, với cực tham chiếu đặt tại vùng cổ tay; đồng thời tiến hành đo đạc đối chiếu thêm trên bó cơ tam đầu (Triceps). Tín hiệu điện cơ thu được dùng để ước lượng góc co duỗi của khuỷu tay người nhằm điều khiển 01 khớp khuỷu tay tương ứng trên mô hình robot thực tế.

4. Quy trình xử lý tín hiệu điện cơ thô từ cảm biến gồm những bước kỹ thuật nào?

Tín hiệu EMGs thô có biên độ nhỏ (0-10 mV) và tần số 0-500 Hz được đưa qua chuỗi xử lý: đầu tiên phân tích phổ tần số bằng biến đổi Fourier rời rạc (DFT/FFT) để xác định các dải tần nhiễu; tiếp theo sử dụng bộ lọc số chủ động Butterworth dải thông để loại bỏ nhiễu trôi đường nền tần số thấp và nhiễu cao tần ngoài dải 20-500 Hz; sau đó dữ liệu được đưa qua bộ lọc Kalman kết hợp với giá trị đo tham chiếu từ cảm biến quán tính IMU để ước lượng góc quay khớp khuỷu tay mượt mà.

5. Giao diện điều khiển và giám sát của robot được phát triển trên công nghệ nào?

Giao diện người - máy (HMI) được lập trình bằng ngôn ngữ C++ trên nền tảng Qt Creator, vận hành trên hệ điều hành Ubuntu Linux. Giao diện bao gồm 5 cửa sổ chức năng: Giới thiệu hệ thống (Introduce), Cài đặt thông số kết nối cổng mạng, Chạy chế độ từng khớp (Jog) và lấy gốc (Set Home), Chạy tự động bài tập phục hồi chức năng theo quỹ đạo quy hoạch, và Tab thực thi điều khiển robot theo thời gian thực bằng cảm biến EMGs.

Kết luận

Đồ án tốt nghiệp của sinh viên Nguyễn Minh Nhựt và Vũ Công Dương đã hoàn thành trọn vẹn việc thiết kế và chế tạo hệ thống điều khiển chuyển động cho robot Exoskeleton 6 bậc tự do kết hợp kênh tín hiệu điện cơ sinh học EMGs. Nghiên cứu đã làm chủ giải thuật động học nghịch DLS kết hợp Gradient Descent để tránh điểm kỳ dị, quy hoạch quỹ đạo đa thức bậc 5 mượt mà và xây dựng thành công mạng truyền thông CAN bus 7 node phân tán với bo mạch Slave tự thiết kế. Kết quả lọc số Butterworth và ước lượng trạng thái Kalman đã chứng minh tính khả thi trong việc ứng dụng tín hiệu điện cơ để điều khiển chuyển động khớp robot khuỷu tay, tạo tiền đề kỹ thuật vững chắc cho việc phát triển các thiết bị robot trợ lực và phục hồi chức năng y tế chuyên sâu tại Việt Nam.