Fixed vision code by changing some varibles, added functions for camera vision and static image vision