Figure 2: Robot used for implementation and test. Equipped with a RPLIDAR A1 scanner.