Search behaviour

Search part is completed and working, however code is not clean yet,
and needs to be tested for the full search (one scan per corner of
objective zone)