Navigation stack Holonomic: true not working
Though i set navigation stack holonomic parameter to true it doesn't generate y velocity. Any suggestions
I am using ROS indigo and Ubuntu 14.04.
Thank you
EDIT: Here are the launch files & output of roswtf:
base_local_planner_params.yaml
TrajectoryPlannerROS:
acc_lim_th: 3.2
acc_lim_x: 2.5
acc_lim_y: 2.5
max_vel_x: 0.65
min_vel_x: 0.0
max_vel_y: 0.1
min_vel_y: -0.1
max_trans_vel: 0.65
min_trans_vel: 0.1
max_rot_vel: 0.5
min_rot_vel: 2.0
sim_time: 1.7
sim_granularity: 0.025
goal_distance_bias: 32.0
path_distance_bias: 24.0
occdist_scale: 0.01
stop_time_buffer: 0.2
oscillation_reset_dist: 0.05
forward_point_distance: 0.325
scaling_speed: 0.25
max_scaling_factor: 0.2
vx_samples: 3
vy_samples: 10
vtheta_samples: 20
sim_period: 0.1
xy_goal_tolerance: 0.2
yaw_goal_tolerance: 0.17
rot_stopped_vel: 0.01
trans_stopped_vel: 0.01
holonomic_robot: true
y_vels: [-0.6, -0.1, 0.1, 0.6]
Costmap_common_params.yaml
obstacle_range: 1
raytrace_range: 1.5
footprint: [[-0.2,-0.2],[-0.2,0.2], [0.2, 0.2], [0.2,-0.2]]
#robot_radius: ir_of_robot
inflation_radius: 3
observation_sources: scan
scan: {sensor_frame: /laser, data_type: LaserScan, topic: /scan, marking: true, clearing: true}
global_costmap_params.yaml
global_costmap:
global_frame: /map
robot_base_frame: /base_link
update_frequency: 1.0
publish_frequency: 0.5
static_map: false
transform_tolerance: 1.5
static_map: false
rolling_window: true
width: 100.0
height: 100.0
local_comstmap_params.yaml
local_costmap:
global_frame: /map
robot_base_frame: /base_link
update_frequency: 5.0
publish_frequency: 2.0
static_map: false
rolling_window: true
width: 6.0
height: 6.0
resolution: 0.05
transform_tolerance: 1.5
planner_frequency: 1.0
planner_patience: 5.0
Output of roswtf
WARNING: Package "ompl" does not follow the version conventions. It should not contain leading zeros (unless the number is 0).
WARNING: Package name "twist_Converter" does not follow the naming conventions. It should start with a lower case letter and only contain lower case letters, digits and underscores.
Loaded plugin tf.tfwtf
No package or stack in context
================================================================================
Static checks summary:
No errors or warnings
================================================================================
Beginning tests of your ROS graph. These may take awhile...
analyzing graph...
... done analyzing graph
running graph rules...
... done running graph rules
running tf checks, this will take a second...
... tf checks complete
Online checks summary:
Found 1 warning(s).
Warnings are things that may be just fine, but are sometimes at fault
WARNING The following node subscriptions are unconnected:
* /mavros:
* /mavros/setpoint_raw/global
* /mavros/setpoint_raw/attitude
* /mavros/setpoint_velocity/cmd_vel
* /mavros/setpoint_position/local
* /tf_static
* /mavlink/to
* /mavros/rc/override
* /mavros/setpoint_raw/local
* /mavros/setpoint_accel/accel
* /move_base:
* /tf_static
* /move_base/cancel
* /rviz:
* /tf_static
Found 1 error(s).
ERROR The following nodes should be connected but aren't:
* /move_base->/move_base (/move_base/global_costmap/footprint)
* /move_base->/move_base (/move_base/local_costmap/footprint)
UPDATE:
I changed to DWA local planner. It too doesnt output linear y velocities.
Edited move_base.local
<launch>
<master auto="start"/>
<node pkg="move_base" type="move_base" respawn="false" name="move_base" output="screen">
<rosparam file="$(find my_robot_name_2dnav)/costmap_common_params.yaml" command="load" ns="global_costmap" />
<rosparam file="$(find my_robot_name_2dnav)/costmap_common_params.yaml" command="load" ns="local_costmap" />
<rosparam file="$(find my_robot_name_2dnav)/local_costmap_params.yaml" command="load" />
<rosparam file="$(find my_robot_name_2dnav)/global_costmap_params.yaml" command="load" />
<rosparam command="load" file="$(find my_robot_name_2dnav)/dwa_local_planner_params.yaml" />
<param name="base_local_planner ...
Please provide launch file. Also include the output of
roswtf
Velocities should be generated regardless of holonomic option.
Thanks for the response @asagitov. I have edited my question to provide launch files and roswtf.
Also @asagitov I do get velocities as output. The nav stack runs fine. However right now i guess any motion suggested by planner is rotate-> move in x -> rotate. What i want is planner to suggest "y vel" which i guess is the property of holonomic constraints
Try changing
y_vels: '-0.6, -0.1, 0.1, 0.6'
toy_vels: [-0.6, -0.1, 0.1, 0.6]
. Maybe it is just syntax error.Hey @asagitov I tried that too. it doesnt work yet. Any other thing that i may be doing wrong?
Looks like local planner decided that is inefficient to move in y plane. Try raising max_vel_y. Also you can try using DWA planner if you are using base_local_planner and vice versa.
Thanks @asagitov. will try that out