# go2w_slam_navigation_ws **Repository Path**: CeasarSmj/go2w_slam_navigation_ws ## Basic Information - **Project Name**: go2w_slam_navigation_ws - **Description**: No description available - **Primary Language**: Unknown - **License**: Not specified - **Default Branch**: master - **Homepage**: None - **GVP Project**: No ## Statistics - **Stars**: 0 - **Forks**: 0 - **Created**: 2025-04-16 - **Last Updated**: 2025-05-14 ## Categories & Tags **Categories**: Uncategorized **Tags**: None ## README # Go2W 扫图导航项目 ## 简述 基于现有的ros1扫图导航项目建立一套用于控制Go2W的系统。 由于Go2W的运动控制服务只支持ros2,所以需要使用ros1_bridge将ros1服务与ros2服务进行桥接。 ros1导航系统来自 ucas-sas rm 团队的仓库:https://gitee.com/ucas-sas-robot-team/ros-navigation-system.git ## 话题桥接规则 | ros1话题 | ros1 数据类型 | ros2话题 | ros2 数据类型 | 方向 | 备注 | | --- | --- | --- | --- | --- | --- | | /move_base_simple/goal | geometry_msgs/PoseStamped | /navigation_goal | geometry_msgs/PoseStamped | 2到1 | 导航目的地 | | /cmd_vel | geometry_msgs/Twist | /cmd_vel | geometry_msgs/Twist | 1到2 | 控制机器人运动 | | 从map到body的TF | tf | 从map到body的TF | tf | 1到2 | TF,表示自己的位置 | | /cloud_registered | sensor_msgs/PointCloud2 | /cloud_registered | sensor_msgs/PointCloud2 | 1到2 | 激光扫描点云 | | /path | /move_base1/DWAPlannerROS/local_plan | /path | /local_plan | 1到2 | 局部路径规划 | | /path | /move_base1/NavfnROS/plan | /path | /global_plan | 1到2 | 全局路径规划 | | /map | sensor_msgs/Image | /map | sensor_msgs/Image | 1到2 | 地图 | ## 编译 ros1部分参见[README.md](./navigation_system_ros1ws/README.md). ros2部分: ```shell source /opt/ros/foxy/setup.bash cd control_system_ros2ws ``` ## 快速启动 机器人的 ros1导航 与 ros2控制桥接 对应本目录下两个脚本,只需要用shell分别执行即可: ```shell bash bridge.bash bash multi_map_launch.bash ``` ## 启动 启动之前需要有先验地图,操作参考[README.md](./navigation_system_ros1ws/README.md). 启动时最好在启动区里面进行,位置偏一点问题不大,但是方向最好是准的,不然就会定位不准,导航无法正常运行。 ros1 部分启动参见它的[README.md](./navigation_system_ros1ws/README.md). ```shell source /opt/ros/noetic/setup.bash source navigation_system_ros1ws/devel/setup.bash roslaunch navigation_pkg all_run ``` 如果是要测试楼梯通行模式,则是: ```shell roslaunch navigation_pkg run_on_stair.launch ``` ros2 部分需要启动一个launch文件来启动控制和桥接: ```shell source /opt/ros/foxy/setup.bash source control_system_ros2ws/install/setup.bash ros2 launch control control_bridge.launch.py ``` 把机器人设置为`地形模式`就会由算法接口接管运动。 ## other 下面是测试代码启动,请忽略: ros2 部分启动需要首先启动一个ros2节点,否则无法正常搭桥。 ```shell source /opt/ros/foxy/setup.bash source control_system_ros2ws/install/setup.bash ros2 run go2w_bridge_controller bridge_controller ``` 这里的 bridge_controller 是一个中继节点,会接收 /cmd_vel 话题,并且调用 unitree_api 的高层运动控制接口来驱动机器人。 然后启动桥节点来连接,桥接参数文件在[control_system_ros2ws/src/bridge4go2w_pkg/config/bridge_config.yaml](control_system_ros2ws/src/bridge4go2w_pkg/config/bridge_config.yaml) ```shell source /opt/ros/foxy/setup.bash source /opt/ros/noetic/setup.bash ros2 run ros1_bridge dynamic_bridge --bridge-config control_system_ros2ws/src/bridge4go2w_pkg/config/bridge_config.yaml --cache-time 1000 ```