You can find the demo in the video below and the schematic and code can be found on the Github link in this post. I am still working on a few glitches, feel free to modify or add any suggestions.