[ARM] 4737/1: Refactor corgi_lcd to improve readability + bugfix