Better algorithm

Changed the obstacle placement process, took into account if the
obstacle had already been spotted, faster decision maker for the robot