Basic skeleton code for GPIO to MUX written.
Began work on RPi2, as well as cleaned up code on RPi1