Hello. I need navigation alghorithm for cleaning robot. In this video show how it must work. The robot moves in straight lines with obstacle avoiding. First I think what I can realise it uses following waypoint for nav stack but on practice it's work bad. Straight lines become arcs and obstacle avoiding also work bad. Big thanks for any ideas ...