Improve potential planner(can handle 1000 pedestrians) and draw the force