This PR updates the MoveIt planner to perform a goal IK solve using the end pose of the seed trajectory (instead of the first pose) as a seed state for the IK solver when checking whether a Cartesian goal is within tolerance of the seed trajectory. This addresses one of the issues in #19
This PR updates the MoveIt planner to perform a goal IK solve using the end pose of the seed trajectory (instead of the first pose) as a seed state for the IK solver when checking whether a Cartesian goal is within tolerance of the seed trajectory. This addresses one of the issues in #19