Assert replaced by return in IKTconstraints check.

This make moveit more stable for inaccurate IK solvers.