Drawing to the screen - based off SCREEN01
Fixed setGpioFunction method so it doesn't reset all other pins
Cleaned up lots of code - easier to read