Cheap way for collision detection completed and tested
Added some methods