lcd_init and function included, lcd_init haven't be tested in user apps