Fix issues with physics overlap and resolution.

Resolution is now I believe 100% correct; this should resolve jitter.
Overlap was broken by me being stupid with exponents during
optimization, and is now correct again.