Added gpio.set() function to change bank and pin number on active gpio
Added preprocessor directives for DEBUG
Some simplifying