Collision response added...

Collision response added... To do: separate the collision response from
the collision detection and add MRU and MRUA formula...