Added dampening option; slightly optimised the collision function with the SAT