simple 2d motion planner with circle based obstacles