Add lcd_print_char and tested in drivertest, lcd_print_str haven't done