Adding in broad phase.
Working on make broad phase.