MobilePositionConstraint handles several hands.
And both hands to environment.
Update tests
Revert "Do not use the distance evaluator."

This reverts commit a832b42437531ec405c218bd43572ca8b472bd6c.
Add benchmark as a test