A 2D Planning Sytem for Robot-Assisted Interventions