На первом же цикле первым же делом единственный раз посчитать разность между текущим временем и временем на предыдущем шаге. Время предыдущего шага писать в ритэйн в конце программы постоянно. В первый раз покажет неправду, но можно добавить инициализацию какую-нибудь.