--> VisionSystem.h: some fixes
--> main: Finished