Refactor LCD and constants
More refactoring; Move code to helper.asm;