ROS2#14 - Path planning thực tế: A*, DWB, TEB và lựa chọn phù hợp

ROS2#14 thuộc lộ trình học ROS2 cho xe tự hành AGV, tập trung vào chủ đề Path planning thực tế: A*, DWB, TEB và lựa chọn phù hợp. Bài viết được thiết kế theo hướng học để triển khai được, không chỉ dừng ở lý thuyết.

Bài viết đưa ra tiêu chí chọn thuật toán thay vì chọn theo trào lưu.

1. Mục tiêu bài học

Bạn sẽ đánh giá độ mượt, độ ổn định và mức tiêu tốn tài nguyên cho từng phương án.

• Nắm vững nội dung cốt lõi của so sánh thuật toán planner/controller cho AGV trong hệ ROS2 cho AGV.
• Thiết lập được môi trường thử nghiệm và quy trình test an toàn cho robot di động.
• Biết cách tổ chức package/node/topic/action để dễ mở rộng dự án thực tế.
• Áp dụng được checklist kiểm thử và tối ưu để hệ thống vận hành ổn định.

2. Kiến thức nền tảng

Để triển khai tốt nội dung so sánh thuật toán planner/controller cho AGV, bạn nên nắm đồng thời kiến thức ROS2, mô hình động học robot và quy trình kiểm thử hệ thống an toàn.

• Kiến trúc ROS2 (node, topic, service, action, parameter, lifecycle).
• Tư duy hệ thống cho AGV: perception, localization, planning, control, safety.
• Nguyên tắc quản lý dữ liệu cảm biến thời gian thực trong môi trường có nhiễu.
• Quy trình debug với ros2 topic echo, rqt, rviz2, rosbag2 và log tracing.

3. Phân tích kỹ thuật

3.1 Góc nhìn hệ thống AGV

AGV là hệ cyber-physical, nên mỗi thay đổi ở perception/planning/control đều có tác động dây chuyền. Bạn cần kiểm tra tính nhất quán giữa dữ liệu cảm biến, trạng thái robot và quyết định điều hướng.

3.2 Thiết kế phần mềm ROS2

Ưu tiên kiến trúc module độc lập theo package để dễ bảo trì: driver package, localization package, planning package, control package và safety supervisor. Mỗi package cần có interface rõ và test tối thiểu.

3.3 Kiểm thử và vận hành

Trước khi chạy thực địa, cần hoàn thành test trong mô phỏng với nhiều tình huống nhiễu, vật cản động và bản đồ chưa hoàn hảo. Dữ liệu rosbag là nguồn chứng cứ quan trọng khi phân tích lỗi.

4. Các bước thực hiện

Chạy cùng kịch bản test để so sánh công bằng giữa các plugin.

1. Xác định mục tiêu của bài ROS2#14 và tiêu chí đo lường kết quả.
2. Thiết lập package, tham số và launch file theo mô hình module tách lớp.
3. Triển khai thuật toán, kết nối cảm biến/driver và kiểm thử từng khối độc lập.
4. Chạy test tích hợp trên mô phỏng trước, sau đó chuyển sang robot thật.
5. Đánh giá log, sửa lỗi biên và tối ưu tham số cho độ ổn định dài hạn.
6. Tổng hợp tài liệu kỹ thuật và bài học rút ra để dùng cho bài kế tiếp.

5. Ví dụ code hoặc pseudo-code

controller_server:
  ros__parameters:
    controller_plugins: ["FollowPath"]
    FollowPath.plugin: "dwb_core::DWBLocalPlanner"

Đoạn code mẫu nhằm minh họa luồng xử lý. Khi triển khai thật, hãy bổ sung timeout, watchdog và cơ chế recovery để đảm bảo an toàn vận hành.

6. Lỗi thường gặp

• Sai frame_id hoặc TF tree khiến dữ liệu định vị và cảm biến không khớp.
• Thiết lập QoS chưa phù hợp làm mất gói tin hoặc trễ dữ liệu quan trọng.
• Không tách rời tầng planning/control dẫn đến khó debug khi robot rung lắc.
• Thiếu cơ chế safety stop khi lidar/camera mất tín hiệu hoặc map lỗi.
• Không log rosbag khi test nên khó phân tích nguyên nhân sự cố.

Không có thuật toán tốt nhất cho mọi môi trường, chỉ có thuật toán phù hợp nhất.

7. Bài tập thực hành

1. Mô phỏng lại bài trong Gazebo hoặc Isaac Sim và ghi rosbag quá trình chạy.
2. Thêm một kịch bản lỗi (mất lidar, lệch map, trễ command) rồi xử lý fallback.
3. Viết checklist commissioning cho môi trường nhà xưởng có người và vật cản.
4. Tối ưu một tham số quan trọng và so sánh trước/sau bằng số liệu cụ thể.

8. Tài liệu tham khảo

• ROS2 Documentation: docs.ros.org.
• Navigation2 Documentation: navigation.ros.org.
• ROS2 Design Articles (QoS, lifecycle, composition, DDS).
• REP-105 / REP-103 về hệ tọa độ và chuẩn frame trong robot di động.
• Tài liệu safety cho robot di động trong nhà máy (ISO 3691-4, IEC liên quan).