Prusa did this way back: https://twitter.com/josefprusa/status/425772744777940992

Unfortunately the source code disappeared from thingiverse...