Multiple joint state publishers, unable to fetch current robot state
Hello,
I'm working with a physical robot (Fetch robot) for motion planning related tasks.
I start the move_group, and then try to plan a path between the start state and a goal state. However, when trying to plan, I get a warning saying that it "failed fetch current robot state".
Upon further investigation, I notice that the robot is publishing to the /joint_states topic
via two publishers: the /robot_driver
and /gripper_driver
. The /robot_driver
publishes all joints except the l_gripper_joint
and r_gripper_joint
, which is published by the /gripper_driver
.
I'm guessing that the move_group planning (and execution) failed due to this reason, that it can never get the complete joint state in any message.
Would also love to have other places where there may be issues (i.e. if the /joint_state may not be the issue). Thanks
Since I cannot internally change the ros interface of the robot, how do I fix this issue? Any help would be appreciated.
Thanks