Rough version of collision manager (unstable)
Implemented collision and contact detection