Here's what I cobbled together for Arduino [1]. It ain't pretty, but it's short and it works.

[1] https://paste.sr.ht/~tsegers/53adaecd734e7159352f152ac1dcc85...