Worked a bit on the vision part of the robot