How jizhang-cmu/autonomy_stack_go2 works
This is a ROS 2 autonomy stack for the Unitree Go2. The principal workflow is: onboard lidar/IMU data is processed by SLAM, terrain and scan analysis produce navigable context, and either waypoint/joystick control or the optional FAR route planner supplies targets to local collision avoidance and path following. Sport API messages command the robot. RViz tools provide goals, waypoints, and teleoperation; Unity simulation and the ROS-TCP endpoint support external simulation and control. Several subsystem links are inferred from documented responsibilities because most node implementations were not sampled.
Main entry points: far_planner.cpp FAR Route Planner · localPlanner.cpp Local Planner · vehicleSimulator.cpp Vehicle Simulator · sensorScanGeneration.cpp Scan Generation
Components 22
Sensing Localization
- Scan Generation
src/base_autonomy/sensor_scan_generation/src/sensorScanGeneration.cpp - SLAM Estimator
src/slam/point_lio_unilidar/src/laserMapping.cpp - Terrain Analysis
src/base_autonomy/terrain_analysis/src/terrainAnalysis.cpp - Terrain Extension
src/base_autonomy/terrain_analysis_ext/src/terrainAnalysisExt.cpp
Mapping Planning
- FAR Route Planner
src/route_planner/far_planner/src/far_planner.cpp - Map Handler
src/route_planner/far_planner/src/map_handler.cpp - Scan Handler
src/route_planner/far_planner/src/scan_handler.cpp - Boundary Handler
src/route_planner/boundary_handler/src/graph_extractor.cpp - Graph Decoder
src/route_planner/graph_decoder/src/decoder_node.cpp
Control Execution
- Local Planner
src/base_autonomy/local_planner/src/localPlanner.cpp - Path Follower
src/base_autonomy/local_planner/src/pathFollower.cpp - Sport API
src/utilities/unitree_pkgs/go2_sport_api/src/common/ros2_sport_client.cpp
User Simulation
- Waypoint Tool
src/utilities/waypoint_rviz_plugin/src/waypoint_tool.cpp - Goalpoint Tool
src/utilities/goalpoint_rviz_plugin/src/goalpoint_tool.cpp - Teleop Panel
src/utilities/teleop_rviz_plugin/src/teleop_panel.cpp - Visualization Tools
src/base_autonomy/visualization_tools/src/visualizationTools.cpp - Vehicle Simulator
src/base_autonomy/vehicle_simulator/src/vehicleSimulator.cpp - ROS TCP Endpoint
src/utilities/ROS-TCP-Endpoint/ros_tcp_endpoint/server.py
Other components
- Go2 Sensors
- Operator
- Unity Simulation
- Go2 Robot
Connections 24
- Go2 Sensors → Scan Generation: provides scans
- Go2 Sensors → SLAM Estimator: provides lidar IMU
- Scan Generation → Terrain Analysis: generates scans
- SLAM Estimator → FAR Route Planner: publishes pose
- Terrain Analysis → Local Planner: provides terrain
- Terrain Extension → Local Planner: extends terrain
- FAR Route Planner → Map Handler: updates map
- FAR Route Planner → Scan Handler: processes scans
- FAR Route Planner → Boundary Handler: extracts boundaries
- FAR Route Planner → Graph Decoder: publishes graph
- Goalpoint Tool → FAR Route Planner: sends goal
- Waypoint Tool → Local Planner: sends waypoint
- Teleop Panel → Local Planner: sends velocity
- FAR Route Planner → Local Planner: sends route
- Local Planner → Path Follower: computes following
- Path Follower → Sport API: creates commands
- Sport API → Go2 Robot: commands motion
- Operator → Waypoint Tool: sets waypoint
- Operator → Goalpoint Tool: sets goal
- Operator → Teleop Panel: drives robot
- Unity Simulation → Vehicle Simulator: provides environment
- Vehicle Simulator → Go2 Sensors: simulates sensors
- ROS TCP Endpoint → Vehicle Simulator: bridges ROS TCP
- Visualization Tools → Operator: shows state