I changed 1 thousand thinks and its not getting better, I thik a class in inappropiate for robot navigation, it slows everything down and produces lots of error