Refactored the main class.
Broad phase collision fix
Plane entity is added