Design and Implementation of an Exploration Algorithm for Autonomous Robots