ROS2#6 - Mô hình động học xe AGV: differential drive và ackermann

ROS2#6 thuộc lộ trình học ROS2 cho xe tự hành AGV, tập trung vào chủ đề Mô hình động học xe AGV: differential drive và ackermann. 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.

Động học là nền tảng để tuning control, planner và giới hạn vận tốc an toàn.

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

Bạn sẽ hiểu mối liên hệ giữa wheel radius, wheel base và vận tốc góc.

• Nắm vững nội dung cốt lõi của động học và ràng buộc chuyển động của 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 động học và ràng buộc chuyển động của 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

Đo tham số thực tế từ robot để cập nhật model thay vì dùng giá trị mặc định.

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

v = (wr + wl) * r / 2.0
w = (wr - wl) * r / L
cmd_vel.linear.x = v
cmd_vel.angular.z = w

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

Sai tham số động học sẽ làm toàn bộ hệ nav2 khó ổn định dù thuật toán đúng.

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