Finalized debug_lcd_init