Updated Finding of Collision Edge, Added Unit Tests

Collision edge is now found by intersection of line between average
intersection point and centre of mass of collider with the collision
edge.

Added unit test for finding collision edge.