Also clamp angular and linear velocities to max speeds while solving constraints

Also clamp angular and linear velocities to max speeds while solving constraints #1427