Míreanna comhchosúla: Integrated Planning and Control for Collision Avoidance Systems