Made visionPlan a bit more modular camera wise