Refactor LCD even further -

- fix hanging test by fixing signed/unsigned types
- get rid of C copypastaz
More refactoring of while loops and mut var usage