Implemented vision algorithm