Non-chain inverse kinematics solver for MoveIt!