Added basic collisions checks and tests.
Added Collision detection and some tests.