FIX LCD STATE & WRITE TO SCREEN

- Set state function was not switching on anything!
- Write to screen outputs individual characters.
- Write to screen now has buffer overflow protection.
- Fix bug that caused text only to output to the bottom part of the LCD.