Fix the bug in broadphase, make the broadphase test all passed