Basic Collision Detection

Added basic collision detection but we still need a movement function.
We should be able to do all collision based on this.