前置条件
机器人爬楼过程中,不可中断,不可将机器人切换为站立
机器人爬楼过程中,滑倒趴下,此时,需要人工将机器人搬至平整地面再控制机器人站立
RQT 采点
RQT 【level_change,确定点位与所在实际楼层保持一致】
命令采点
上楼
ros2 service call /ROBOT_NAME/take_stairs_points daystar_navigation_msgs/srv/GenerateStairsPoints "upstairs: 'upstairs'
point_name: 'p1'
change_map: false"
ros2 service call /ROBOT_NAME/take_stairs_points daystar_navigation_msgs/srv/GenerateStairsPoints "upstairs: 'upstairs'
point_name: 'p2'
change_map: false"
ros2 service call /ROBOT_NAME/take_stairs_points daystar_navigation_msgs/srv/GenerateStairsPoints "upstairs: 'upstairs'
point_name: 'p3'
change_map: false"
ros2 service call /ROBOT_NAME/take_stairs_points daystar_navigation_msgs/srv/GenerateStairsPoints "upstairs: 'upstairs'
point_name: 'p4'
change_map: false"
ros2 service call /ROBOT_NAME/take_stairs_points daystar_navigation_msgs/srv/GenerateStairsPoints "upstairs: 'upstairs'
point_name: 'p5'
change_map: true"
切换地图信息,注意:上楼梯时floor name(如果从1层到2层则填L2)
ros2 service call /stairs_map_info daystar_navigation_msgs/srv/StairsPointsMapInfo "floor_name: 'L2'
map_name: '0809-B1'"
下楼
RQT 【level_change,确定点位与所在实际楼层保持一致】
ros2 service call /ROBOT_NAME/take_stairs_points daystar_navigation_msgs/srv/GenerateStairsPoints "upstairs: 'downstairs'
point_name: 'p5'
change_map: false"
ros2 service call /ROBOT_NAME/take_stairs_points daystar_navigation_msgs/srv/GenerateStairsPoints "upstairs: 'downstairs'
point_name: 'p4'
change_map: false"
ros2 service call /ROBOT_NAME/take_stairs_points daystar_navigation_msgs/srv/GenerateStairsPoints "upstairs: 'downstairs'
point_name: 'p3'
change_map: false"
ros2 service call /ROBOT_NAME/take_stairs_points daystar_navigation_msgs/srv/GenerateStairsPoints "upstairs: 'downstairs'
point_name: 'p2'
change_map: false"
ros2 service call /ROBOT_NAME/take_stairs_points daystar_navigation_msgs/srv/GenerateStairsPoints "upstairs: 'downstairs'
point_name: 'p1'
change_map: true"
切换地图信息,注意:上楼梯时floor name(如果从2层到1层则填L1)
ros2 service call /stairs_map_info daystar_navigation_msgs/srv/StairsPointsMapInfo "floor_name: 'L1'
map_name: '0809-B1'"
RQT采点
打开RVIZ2 点击 3D Pose Estimate
按住鼠标左键,同时按住鼠标右键,向上拖动鼠标(绿色箭头叠加为机器人高度)
验证
下楼验证
确认机器人“机器人上楼采点示意”图所示33号点附近
ros2 service call /ROBOT_NAME/climb_stairs daystar_navigation_msgs/srv/Stairs "upstairs: 'downstairs'"
上楼验证
确认机器人“机器人上楼采点示意”图所示22号点附近
ros2 service call /ROBOT_NAME/climb_stairs daystar_navigation_msgs/srv/Stairs "upstairs: 'upstairs'"
注意事项
机器人爬楼异常
如上图,机器人自动爬楼过程中出现,左偏,右偏,撞墙等问题
拨动遥感,使其回到楼梯中间,并遥控机器人到平整地区
在L2重启了机器人
如果在L2重启了机器人
打开RVIZ2 点击 3D Pose Estimate
按住鼠标左键,同时按住鼠标右键,向上拖动鼠标(绿色箭头叠加为机器人高度)