navigation_stage is not working while connecting to robotino

asked 2016-09-29 10:33:36 -0600

rasoo gravatar image

Hello all, I am struggling to implement the ROS navigation using Robotino. I an using navigation_stage. Withouht connecting the robot it works but when I connect the robotino, it start blinking and the map start jumping in different position. A screenshot is given here in the image.

My launch file is as below:

<launch> <master auto="start"/> <include file="$(find navigation_stage)/move_base_config/move_base.xml"/> <node name="map_server" pkg="map_server" type="map_server" args="$(find navigation_stage)/stage_config/maps/module_B2.png 0.05" respawn="false"/> <node pkg="stage_ros" type="stageros" name="stageros" args="$(find navigation_stage)/stage_config/worlds/module_B.world" respawn="false" &gt;="" <param="" name="base_watchdog_timeout" value="0.2"/> </node> <include file="$(find navigation_stage)/move_base_config/amcl_node.xml"/>
<node name="rviz" pkg="rviz" type="rviz" args="-d $(find navigation_stage)/single_robot.rviz"/> </launch>


======================================================================================= World file is given below:


define block model ( size [0.5 0.5 0.75] gui_nose 0 )

define topurg ranger ( sensor( range_max 30.0 fov 270.25 samples 1081 ) # generic model properties color "black" size [ 0.05 0.05 0.1 ] )

define pr2 position ( pose [ 8.5 1.5 0.0 140.0 ]

odom_error [0.03 0.03 999999 999999 999999 0.02]

size [0.25 0.25 0.25] origin [0.0 0 0 0] gui_nose 1 drive "omni" topurg(pose [ 0.275 0.000 0 0.000 ])

)

define floorplan model ( # sombre, sensible, artistic color "gray30"

# most maps will need a bounding box boundary 1

gui_nose 0 gui_grid 0

gui_outline 0 gripper_return 0 fiducial_return 0 ranger_return 1 )

set the resolution of the underlying raytrace model in meters

resolution 0.1

interval_sim 100 # simulation timestep in milliseconds

window ( size [ 600.0 700.0 ] center [ 0.0 0.0 ] rotate [ 0.0 0.0 ] scale 50 )

load an environment bitmap

floorplan ( name "rasel_lab" bitmap "../maps/module_B2.png" size [10.0 10.00 2.0] pose [ 5.0 5.0 0.0 0.0 ] )

throw in a robot

pr2( pose [ 2.0 5.0 0 28.00 ] name "robotino_rasel" color "blue")

#block( pose [ -24.269 48.001 0 180.000 ] color "red")

My robot is robotino and having no laser scan device. I always get the warning message "The origin for the sensor at (12.29, 25.99, 0.25) is out of map bounds. So, the costmap cannot raytrace for it. "

The global costmap is as below:


global_costmap: #Set the global and robot frames for the costmap global_frame: /map robot_base_frame: base_link

#Set the update and publish frequency of the costmap update_frequency: 5.0 publish_frequency: 0.0

#We'll use a map served by the map_server to initialize this costmap static_map: true rolling_window: false

footprint_padding: 0.02

and the local costmap is :

local_costmap: #We'll publish the voxel grid used by this costmap publish_voxel_map: true

#Set the global and robot frames for the costmap global_frame: odom robot_base_frame: base_link

#Set the update and publish frequency of the costmap update_frequency: 5.0 publish_frequency: 2.0

#We'll configure this costmap to be a rolling window... meaning it is always #centered at the robot static_map: true rolling_window: true ... (more)

edit retag flag offensive close merge delete