Added a clean version of my VisionsubsystemV2, and made the VisionSubsystem work will little change as possible to it.