Hardware Algorithm Complete. Refactor'd demo code into file structure