Correct TP algorithm with fixed point (to be tested).