Implementing ZUPT

[Atlis]

Hello,

I want to implement ZUPT (zero velocity updates). I first thought it would be a piece of cake but I came to the realisation that I have to master the theory first... which is not out of reach, but certainly going to take least a couple of days. Still, the solution might be really simple so I'm taking a chance here. Perhaps someone could provide the solution in just a few key lines of code.

Thanks to anyone!
And a big thanks to Ross Hartley for sharing.