A New Local Planner Based on Pedestrian Model and Its Safety Guarantee with Collision Arc