FWIW, here it is. It's not pretty code, but should at least be quite solid. There's only so much structuring you can do with GOTO 😉

Consider it licensed as GPL code.