Added the currently working code that was on the #49 pi