Also das erste was mir auffällt, ist, dass du die Endlosschleife am Ende vergessen hast.
So kann es zu Probleme kommen. Weiterhin sind die Distanzen am Anfang immer 0 also macht das erste Auslesen schonmal keinen Sinn
Ansonsten lass dir den Wert doch mal über UART ausgeben.
Vielleicht sind deine Encoder nicht richtig kalibriert.

EDIT: Ich sehe grade das Problem: soweit ich weiß, ist die gemessene Distanz nicht in Zentimerter oder so, sondern in Zählschritten...
Dann kann das mit dem DIST_MM /CM nicht klappen.