Fixed collision detection bug, should run faster, invMass works properly now
Forgot to add this file