Moveit group moves only one joint at a time in RVIZ
Hi,
I am following the tutorial of Move Group C++ interface for UR5 robot. The problem I am facing is that the robot moves only one joint at a time to reached a Target.
I have tried both methods of reaching the target, either by planning to a Pose goal or by planning to a joint-space goal and the result is the same. I have to run the command
move_group.move(); or
move_group.asyncMove()
several times to reach to the target. The planning part is working fine and reached the target every time.
I am using ubuntu 16.04 (64bit) and ROS Kinetic.
Following is my Launch file : <launch> <arg name="sim" default="true"/> <arg name="robot_ip" unless="$(arg sim)"/> <arg name="db" default="false"/>
<arg name="debug" default="false"/> <arg name="limited" default="true"/>
<include file="$(find ur5_moveit_config)/launch/planning_context.launch"> <arg name="load_robot_description" value="true"/> <arg name="limited" value="$(arg limited)"/> </include>
<group if="$(arg sim)"> <node name="joint_state_publisher" pkg="joint_state_publisher" type="joint_state_publisher"> <rosparam param="/source_list">[/move_group/fake_controller_joint_states]</rosparam> </node> </group>
<group unless="$(arg sim)"> <include file="$(find ur5_moveit_config)/launch/ur5_bringup.launch"> <arg name="robot_ip" value="$(arg robot_ip)"/> </include> </group>
<group if="$(arg sim)"> <include file="$(find ur5_moveit_config)/launch/move_group.launch"> <arg name="limited" value="$(arg limited)"/> <arg name="allow_trajectory_execution" value="true"/> <arg name="fake_execution" value="true"/> <arg name="info" value="true"/> <arg name="debug" value="$(arg debug)"/> </include> </group>
<group unless="$(arg sim)"> <include file="$(find ur5_moveit_config)/launch/move_group.launch"> <arg name="limited" default="true"/> <arg name="publish_monitored_planning_scene" value="true"/> </include> </group>
<include file="$(find ur5_moveit_config)/launch/moveit_rviz.launch"> <arg name="config" value="true"/> </include>
<include file="$(find ur5_moveit_config)/launch/default_warehouse_db.launch" if="$(arg db)"/> <node name="goal" pkg="ur5_moveit_config" type="goal" respawn="false" output="screen"/> </launch>