Better grade smoothing
Issue #81
new
Seems to always lag behind velocity and sometimes messes up with NP
Seems to always lag behind velocity and sometimes messes up with NP