Debugged object recognition

It works now. Recognizes blue blocks most of the time, except when they
get a little two far (~5 cm). Works well with blocks at an angle.