Added and filled out vision subsystem