Changes in VisionSystem.h and main.cpp