Title: Integrated Planning and Control for Collision Avoidance Systems