Also, I would recommend using the ur_kinematics analytic solution for the UR5 since it is much much faster than any iterative solver (kdl or trac_ik) --- [Visit Topic](https://discourse.ros.org/t/moveit-motion-planning-issue/7641/7) or reply to this email to respond.