first algo (forward and stop when see obstacle) and add Logger