small optimization to iterative solver
Compute proper friction constraint limit, fixes #7