Fixed bug in lcd_init