re-implemented ndt, might work, stepSize problem