ROS2#12 - Navigation2 stack: planner, controller, behavior tree

ROS2#12 thuộc lộ trình học ROS2 cho xe tự hành AGV, tập trung vào chủ đề Navigation2 stack: planner, controller, behavior tree. 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.

Nav2 là trái tim điều hướng trong ROS2, cần cấu hình đồng bộ nhiều thành phần.

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

Bạn sẽ hiểu luồng từ goal đến path và command velocity thông qua behavior tree.

• Nắm vững nội dung cốt lõi của cấu hình nav2 đầy đủ cho điều hướng 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 cấu hình nav2 đầy đủ cho điều hướng 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

So sánh planner/controller plugins theo từng loại môi trường.

1. Xác định mục tiêu của bài ROS2#12 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

bt_navigator:
  ros__parameters:
    default_bt_xml_filename: "navigate_w_replanning_and_recovery.xml"

Đ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ố.

Đừng chỉnh một plugin riêng lẻ; hãy nhìn hiệu năng toàn chuỗi nav2.

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).