NXT, 2 мотора, 2 датчика УЗВ, алгоритм движения по стенке