As mentioned in the Lepton Deku Mod thread, I will be doing exactly this today. I was debating how to implement it just for digital hall sensors, but if it can be useful for other sensors like this I will make it generic. It was looking like it would have to hook in at the motor level anyway, since the estimation needs to be done using the filtered velocity.