v2: Fix stability problems

v1 used a sliding window to maintain a stable update frequency, but it suffered from stability issues when there were disturbances. This update fixes the problems and slightly changes the API.