Added a variable cosThetaMargin to object recog.

Now brighter colors are evaluated more strictly. So going up to a wall wil
light intensity 300 and theta 8, it will be rejected. But a blue block
with light intensity 50 and theta 6 will be accepted.