Arreglar ángulos Roll-Pitch Arreglar estimación del Total Cost, tomando el valor del nodo más cercano en vez de interpolar