IR/US sensor improvements

+ first obstacle avoiding strategy