auxdisplay: charlcd: Reuse hex_to_bin() instead of custom code

hex_to_bin() may be used to convert hexdecimal digit to its binary
representation.

Signed-off-by: Andy Shevchenko <andriy.shevchenko@linux.intel.com>
Signed-off-by: Miguel Ojeda <miguel.ojeda.sandonis@gmail.com>
This commit is contained in:
Andy Shevchenko 2020-05-18 22:36:17 +03:00 committed by Miguel Ojeda
parent 9cb1fd0efd
commit 3f03b64981
1 changed files with 8 additions and 13 deletions

View File

@ -485,24 +485,19 @@ static inline int handle_lcd_special_code(struct charlcd *lcd)
shift = 0; shift = 0;
value = 0; value = 0;
while (*esc && cgoffset < 8) { while (*esc && cgoffset < 8) {
shift ^= 4; int half;
if (*esc >= '0' && *esc <= '9') {
value |= (*esc - '0') << shift;
} else if (*esc >= 'A' && *esc <= 'F') {
value |= (*esc - 'A' + 10) << shift;
} else if (*esc >= 'a' && *esc <= 'f') {
value |= (*esc - 'a' + 10) << shift;
} else {
esc++;
continue;
}
shift ^= 4;
half = hex_to_bin(*esc++);
if (half < 0)
continue;
value |= half << shift;
if (shift == 0) { if (shift == 0) {
cgbytes[cgoffset++] = value; cgbytes[cgoffset++] = value;
value = 0; value = 0;
} }
esc++;
} }
lcd->ops->write_cmd(lcd, LCD_CMD_SET_CGRAM_ADDR | (cgaddr * 8)); lcd->ops->write_cmd(lcd, LCD_CMD_SET_CGRAM_ADDR | (cgaddr * 8));