I am using MoveIt to plan trajectories for my simple robotic arm (3 DOF). I have a force_torque sensor gazebo plugin inside my urdf that can publish force/torque values in one of the joints of the arm. Now while planning a trajectory for the arm in MoveIt, I want to know what is the torque in that joint. If the torque is less than a specified value, I want to go ahead and execute the planning; if not, don't execute the planning.
I know that once I execute the planning and simulate in gazebo, I can get the torque values from the force_torque rostopic published by the gazebo sensor plugin. But can I get that info while planning. Does the MoveIt planning publish or store that info somewhere?
↧