[mikets]

I don't know how this could cause the lag either. Then why did you say this is the most likely culprit? In any case, since you are using float, you should use fabs() instead of abs(). I don't know what abs() will do to float. But if it truncates it to integer, you could still be dividing by zero.