Bug2 Algorithm for Robot Planning and Navigation