Refactor LCD even further -

- fix hanging test by fixing signed/unsigned types
- get rid of C copypastaz and not needed mut vars
- more refactoring of while loops