Collision detection helper class added, with tests

Helper class is for CollisionManager, needs more testing with updated
code.