Fixed IK closeness evaluator.
Updated KDL 1000x bug error.

Must set flag to activate fix now.
Commented out IK test code.