Tổng quan nghiên cứu

Theo thống kê của Tổ chức Y tế Thế giới, hiện có khoảng hơn 10% dân số toàn cầu là người cao tuổi hoặc người khuyết tật gặp trở ngại về chức năng vận động, tạo ra nhu cầu cấp thiết đối với các thiết bị trợ chuyển động thông minh. Tại Việt Nam, đa số phương tiện hỗ trợ di chuyển hiện nay vẫn dừng lại ở dạng xe lăn cơ học đẩy tay hoặc xe lăn điện có gắn cần gạt điều khiển thủ công (joystick). Nghiên cứu về xe lăn tự hành có khả năng tự định vị, quy hoạch đường đi và né tránh vật cản mà không cần sự can thiệp trực tiếp từ con người là một lĩnh vực hoàn toàn mới và mang ý nghĩa thực tiễn to lớn.

Mục tiêu trọng tâm của luận văn là xây dựng hệ thống định vị cục bộ và điều hướng tự động cho xe lăn di động trong môi trường trong nhà đã biết trước bản đồ. Đề tài tập trung giải quyết bài toán ước lượng trạng thái bằng thuật toán lọc Kalman mở rộng (EKF) dựa trên dữ liệu từ cảm biến laser SICK LMS 291, trích xuất điểm mốc tự nhiên qua thuật toán Incremental, đồng thời tích hợp thuật toán tìm đường D-star và phương pháp tránh va chạm Vector Field Histogram (VFH). Phạm vi nghiên cứu được triển khai thực nghiệm trên mô hình xe lăn thực tế sử dụng cơ cấu lái vi sai có khoảng cách trục bánh 600 mm (bán khoảng cách b = 300 mm).

Ý nghĩa khoa học của công trình nằm ở việc kết hợp hài hòa giữa định vị tương đối (Dead Reckoning) và định vị tuyệt đối bằng laser, giúp triệt tiêu hoàn toàn sự tích lũy sai số theo thời gian. Các chuỗi thực nghiệm kéo dài từ 60 đến 115 giây đã chứng minh độ tin cậy vượt trội của hệ thống, kiểm soát sai số tọa độ ở mức tối thiểu và duy trì tính ổn định liên tục trong quá trình vận hành tự hành.

Cơ sở lý thuyết và phương pháp nghiên cứu

Khung lý thuyết áp dụng

Nghiên cứu được xây dựng dựa trên các nền tảng lý thuyết và mô hình tính toán cốt lõi sau:

  • Lý thuyết xác suất Bayes và mô hình phân bố Gauss: Đóng vai trò là nền tảng toán học để xác định phân phối độ tin cậy trạng thái bel(x_t) = p(x_t | z_{1:t}, u_{1:t}), biểu diễn sự không chắc chắn của vị trí và hướng thông qua giá trị trung bình mu_t và ma trận hiệp phương sai Sigma_t.
  • Mô hình động học vi sai của xe lăn: Xác định quy luật biến thiên vị trí x, y và góc hướng theta theo vận tốc hai bánh xe (V_l, V_r) cùng khoảng cách trục bánh xe L = 600 mm trong khoảng thời gian Delta_t.
  • Thuật toán lọc Kalman mở rộng (EKF): Kỹ thuật tuyến tính hóa các phương trình trạng thái và đo lường phi tuyến bằng khai triển chuỗi Taylor bậc 1, sử dụng các ma trận Jacobian G_t và H_t để tính toán bước dự đoán và cập nhật.
  • Ba khái niệm chính trong đề tài:
    1. Sai số tích lũy Dead Reckoning: Hiện tượng trôi dạt góc và quãng đường do sự trượt của bánh xe khi thu thập tín hiệu từ encoder.
    2. Trích xuất đặc trưng hình học: Sử dụng phương pháp bình phương bé nhất (Least Square) kết hợp thuật toán gia số (Incremental) để nhận diện các đoạn thẳng tường và điểm mốc tự nhiên (Natural Landmarks).
    3. Biểu đồ cực 1 chiều (Polar Histogram): Kỹ thuật lượng tử hóa không gian chướng ngại vật trong giải thuật VFH nhằm xác định cung góc di chuyển an toàn cho xe lăn.

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

Nguồn dữ liệu thực nghiệm được thu thập từ cảm biến laser SICK LMS 291 có tầm quét xa tới 8 m, góc quét 180 độ, cung cấp từ 101 đến 361 điểm khoảng cách trong mỗi chu kỳ quét, kết hợp cùng 2 bộ mã hóa vòng quay encoder quang học gắn trực tiếp trên trục truyền động và hệ thống 7 cảm biến siêu âm phụ trợ.

Cỡ mẫu dữ liệu bao gồm hàng nghìn điểm đo khoảng cách và góc được lấy mẫu liên tục theo thời gian thực với chu kỳ bước trích mẫu Dt = 1 giây. Phương pháp chọn mẫu là đo lường liên tục toàn phần dọc theo quỹ đạo chuyển động qua 3 kịch bản thực nghiệm độc lập trong phòng thí nghiệm: kịch bản 1 kéo dài 86 giây, kịch bản 2 kéo dài 115 giây và kịch bản 3 kéo dài 60 giây.

Lý do lựa chọn phương pháp phân tích: Thuật toán EKF được chọn thay vì bộ lọc hạt (Particle Filter) vì EKF có chi phí tính toán thấp, tốc độ xử lý nhanh, đáp ứng hoàn hảo yêu cầu điều khiển thời gian thực trên vi xử lý nhúng mà vẫn duy trì độ chính xác cao đối với bài toán định vị cục bộ (Position Tracking). Đồng thời, thuật toán tìm đường D-star được ưu tiên hơn thuật toán A-star cổ điển nhờ khả năng cập nhật danh sách nút mở (Open List) cực nhanh khi xuất hiện vật cản mới, giúp tái lập lộ trình tối ưu mà không cần tính toán lại từ đầu toàn bộ bản đồ.

Kết quả nghiên cứu và thảo luận

Những phát hiện chính

Nghiên cứu đã ghi nhận các kết quả thực nghiệm nổi bật sau:

  • Thứ nhất, bộ lọc EKF triệt tiêu hoàn toàn hiện tượng trôi dạt tọa độ của phương pháp tích phân vận tốc thuần túy. Trong thực nghiệm thứ nhất (thời gian chạy từ 0 đến 86 giây), sai số vị trí theo trục x và trục y luôn được giới hạn ổn định trong biên độ dưới 5 cm, giảm hơn 65% độ lệch tích lũy so với mô hình động học vi sai thông thường.
  • Thứ hai, thuật toán trích xuất điểm mốc Incremental kết hợp kỹ thuật Least Square theo cả hai trục tọa độ x và y đã nhận diện chính xác 100% các đoạn tường và góc phòng từ dữ liệu 101 đến 361 điểm laser với độ phân giải góc 1 độ, khắc phục triệt để nhược điểm bỏ sót các đường thẳng song song trục tung khi chỉ khớp đường theo trục y.
  • Thứ ba, giải thuật quy hoạch quỹ đạo D-star phối hợp cùng Vector Field Histogram (VFH) đã giúp xe lăn tự động phát hiện và né tránh an toàn 1 vật cản ở thực nghiệm 1, 2 vật cản ở thực nghiệm 2 (thời gian 115 giây) và 3 vật cản ở thực nghiệm 3 (thời gian 60 giây). Hệ thống tái lập đường đi mới trơn tru, không xảy ra va chạm hay hiện tượng kẹt góc.
  • Thứ tư, thời gian đáp ứng tính toán cho mỗi chu kỳ lọc EKF và cập nhật biểu đồ cực đạt dưới 100 ms, đảm bảo xe lăn phản ứng kịp thời với các chướng ngại vật bất ngờ ở vận tốc di chuyển tiêu chuẩn trong nhà.

Thảo luận kết quả

Nguyên nhân chính giúp hệ thống đạt độ chính xác cao là nhờ cơ chế kết hợp dữ liệu cảm biến đa tầng. Bước dự đoán khai thác tốc độ lấy mẫu cao của encoder gắn trên trục bánh vi sai 600 mm, trong khi bước cập nhật sử dụng ma trận hiệp phương sai đo lường R_t (với các hệ số sai số laser sigma_x = 5, sigma_y = 5, sigma_theta = 1) để hiệu chỉnh độ lệch tức thời thông qua độ lợi Kalman K_t.

So sánh với nghiên cứu năm 2012 của tác giả Lê Hoàng Anh sử dụng camera Kinect và thuật toán A-star, phương án dùng cảm biến laser SICK LMS 291 trong luận văn này vượt trội hơn hẳn về tầm quét (8 m so với 3.5 m) và khả năng làm việc ổn định không phụ thuộc vào điều kiện ánh sáng môi trường. Đồng thời, so với nghiên cứu mô phỏng bộ lọc hạt Particle Filter năm 2011 của tác giả Nguyễn Đặng Phúc Nguyên, phương pháp EKF giúp tiết kiệm hơn 50% tài nguyên xử lý của vi điều khiển trung tâm.

Các kết quả thực nghiệm có thể được biểu diễn trực quan qua biểu đồ sai số vị trí theo trục x và y từ giây 0 đến 115. Biểu đồ cho thấy các đỉnh sai số xuất hiện cục bộ khi xe lăn xoay hướng nhanh chóng được thuật toán kéo về tiệm cận mức 0 chỉ sau 1 đến 2 chu kỳ đo lường, minh chứng cho tính hội tụ vững chắc của mô hình toán học đã thiết lập.

Đề xuất và khuyến nghị

Nhằm hoàn thiện và nâng cao khả năng thương mại hóa hệ thống xe lăn tự hành, các giải pháp cụ thể được đề xuất như sau:

  • Tích hợp thêm cảm biến quán tính IMU 9 trục và camera đo chiều sâu nhằm nâng cao độ chính xác góc quay, phấn đấu giảm sai số vị trí xuống dưới mức 2 cm và mở rộng góc quan sát lên 360 độ trong lộ trình 6 tháng, thực hiện bởi nhóm kỹ sư cơ điện tử và xử lý tín hiệu.
  • Nghiên cứu cơ chế giải quyết bài toán bắt cóc vị trí (Kidnapped Robot Problem) bằng cách kết hợp bộ lọc hạt thích nghi KLD-PF ở pha khởi động, cho phép xe tự nhận diện lại tọa độ trong thời gian dưới 2 giây sau khi bị dịch chuyển đột ngột, mục tiêu hoàn thiện trong vòng 9 tháng bởi các nhà nghiên cứu thuật toán điều khiển.
  • Phát triển giao diện điều khiển đa phương thức tương tác qua giọng nói, cử chỉ đầu và sóng não với độ trễ phản hồi dưới 200 ms nhằm phục vụ những bệnh nhân bị liệt toàn thân hoặc chấn thương cột sống nặng, triển khai trong 12 tháng bởi nhóm nghiên cứu kỹ thuật y sinh.
  • Mở rộng thử nghiệm lâm sàng trên quy mô tối thiểu 20 người dùng thực tế tại các trung tâm phục hồi chức năng và bệnh viện trong thời gian 18 tháng, do các trường đại học phối hợp với các cơ sở y tế chuyên khoa tiến hành đánh giá độ an toàn tổng thể.

Đối tượng nên tham khảo luận văn

Nội dung và kết quả nghiên cứu của luận văn mang lại giá trị tham khảo thiết thực cho 4 nhóm đối tượng:

  • Kỹ sư phát triển Robot và Xe tự hành: Nắm bắt phương pháp triển khai chi tiết các ma trận Jacobian trong bộ lọc Kalman mở rộng (EKF) cho hệ dẫn động vi sai kích thước 600 mm, phục vụ thiết kế robot di động công nghiệp (AGV/AMR).
  • Học viên cao học và Nghiên cứu sinh ngành Cơ điện tử, Tự động hóa: Tham khảo quy trình xây dựng hệ thống phần cứng hoàn chỉnh tích hợp cảm biến laser SICK LMS 291, encoder và vi điều khiển cùng các thuật toán tìm đường D-star, tránh vật cản VFH.
  • Doanh nghiệp sản xuất thiết bị y tế và hỗ trợ người khuyết tật: Khai thác giải pháp công nghệ xe lăn thông minh với cấu trúc module hóa, chi phí hợp lý để phát triển sản phẩm thương mại phục vụ thị trường chăm sóc sức khỏe.
  • Giảng viên và Nhà nghiên cứu Robotics: Sử dụng làm tài liệu giảng dạy chuyên sâu về bài toán định vị cục bộ, xử lý tín hiệu cảm biến thời gian thực và thuật toán trích xuất đặc trưng hình học Incremental từ dữ liệu laser.

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

Tại sao nghiên cứu lại lựa chọn bộ lọc Kalman mở rộng thay vì bộ lọc hạt?

Bộ lọc Kalman mở rộng (EKF) có ưu thế vượt trội về tốc độ tính toán và độ ổn định khi xử lý bài toán định vị cục bộ. Với chu kỳ trích mẫu 1 giây và hệ dẫn động vi sai 600 mm, EKF tiêu tốn ít bộ nhớ vi xử lý hơn đáng kể so với việc phải duy trì hàng nghìn phần tử mẫu của bộ lọc hạt, đảm bảo hệ thống vận hành thời gian thực mượt mà.

Cảm biến laser SICK LMS 291 mang lại lợi thế gì so với camera Kinect?

Cảm biến laser SICK LMS 291 sở hữu tầm quét xa tới 8 m cùng góc quét rộng 180 độ với sai số đo khoảng cách chỉ 0.5 cm. Khác với camera Kinect dễ bị nhiễu dưới ánh sáng mạnh hoặc bóng tối, dữ liệu laser luôn duy trì tính ổn định cao, tốc độ truyền nhận nhanh và giảm tải tối đa cho khâu xử lý thuật toán.

Thuật toán Incremental hỗ trợ trích xuất vật mốc tự nhiên như thế nào?

Thuật toán Incremental phân tích chuỗi 101 đến 361 điểm đo từ laser, kết hợp phương pháp Least Square theo cả hai trục x và y để nhận diện các bức tường và góc phòng. Thuật toán phân đoạn chính xác các đường thẳng với sai số góc dưới 0.1 rad, cung cấp tọa độ vật mốc thực tế phục vụ trực tiếp cho bước cập nhật đo lường của EKF.

Sự phối hợp giữa thuật toán D-star và phương pháp VFH diễn ra ra sao?

Khi phát hiện vật cản bất ngờ, D-star cập nhật lại danh sách nút mở để tìm lộ trình thay thế tối ưu trên bản đồ lưới mà không cần tính toán lại từ đầu. Đồng thời, giải thuật Vector Field Histogram (VFH) xây dựng biểu đồ cực để điều khiển xe lách qua chướng ngại vật một cách an toàn trong suốt các thử nghiệm kéo dài 60 đến 115 giây.

Hiện tượng trượt bánh xe vi sai được xử lý triệt để bằng cách nào?

Sai số tích lũy do trượt bánh xe (Dead Reckoning) từ 2 bộ encoder được hiệu chỉnh liên tục thông qua bước cập nhật đo lường của EKF. Nhờ việc đối chiếu tọa độ vật mốc đo được từ laser với bản đồ mẫu, độ lợi Kalman K_t tự động điều chỉnh và kéo sai số vị trí về mức xấp xỉ 0, triệt tiêu hoàn toàn sự trôi dạt tọa độ.

Kết luận

  • Xây dựng hoàn chỉnh mô hình động học và thuật toán định vị cục bộ EKF cho xe lăn tự hành sử dụng cơ cấu lái vi sai 600 mm.
  • Trích xuất thành công 100% các vật mốc tự nhiên từ dữ liệu 101 đến 361 điểm laser SICK LMS 291 nhờ thuật toán Incremental và phương pháp Least Square hai chiều.
  • Tích hợp hiệu quả giải thuật tìm đường động D-star và thuật toán né tránh chướng ngại vật VFH, vượt qua an toàn tới 3 vật cản trong các thử nghiệm thực tế từ 60 đến 115 giây.
  • Triệt tiêu hoàn toàn sai số trôi dạt của hệ thống đo quãng đường vi sai, duy trì sai số định vị trong giới hạn an toàn dưới 5 cm.
  • Định hình nền tảng phần cứng và phần mềm nhúng hoàn chỉnh, tạo tiền đề vững chắc cho việc phát triển các thiết bị y tế tự hành tại Việt Nam.

Đóng góp lớn nhất của luận văn là đã làm chủ công nghệ tích hợp cảm biến laser và giải thuật định vị EKF trên mô hình thực nghiệm thực tế. Kế hoạch phát triển tiếp theo trong 12 tháng tới sẽ tập trung vào kỹ thuật SLAM 3D toàn cục và thử nghiệm tương tác người - máy. Các nhà nghiên cứu và doanh nghiệp quan tâm có thể ứng dụng trực tiếp khung giải thuật này để nâng cao năng lực tự hành cho các phương tiện di chuyển thông minh.