convergence

Shoudl both tune the velocity / position converence criteria, but also make them configurable for the user, if you e..g want to use them for rotations they need be much stricter. (Maybe also introduce one for a simple float var?)