diff options
Diffstat (limited to 'src/lib')
-rw-r--r-- | src/lib/Makefile.inc | 1 | ||||
-rw-r--r-- | src/lib/hexstrtobin.c | 44 |
2 files changed, 45 insertions, 0 deletions
diff --git a/src/lib/Makefile.inc b/src/lib/Makefile.inc index 734b517b01..b446e10a35 100644 --- a/src/lib/Makefile.inc +++ b/src/lib/Makefile.inc @@ -114,6 +114,7 @@ ramstage-y += cbfs.c ramstage-$(CONFIG_COMMON_CBFS_SPI_WRAPPER) += cbfs_spi.c ramstage-y += lzma.c lzmadecode.c ramstage-y += stack.c +ramstage-y += hexstrtobin.c ramstage-y += wrdd.c ramstage-$(CONFIG_CONSOLE_CBMEM) += cbmem_console.c ramstage-$(CONFIG_BOOTSPLASH) += jpeg.c diff --git a/src/lib/hexstrtobin.c b/src/lib/hexstrtobin.c new file mode 100644 index 0000000000..ed2abc4e8b --- /dev/null +++ b/src/lib/hexstrtobin.c @@ -0,0 +1,44 @@ +/* + * Copyright 2016 Google Inc. + * + * This program is free software; you can redistribute it and/or modify + * it under the terms of the GNU General Public License as published by + * the Free Software Foundation; version 2 of the License. + * + * This program is distributed in the hope that it will be useful, + * but without any warranty; without even the implied warranty of + * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the + * GNU General Public License for more details. + */ + +#include <lib.h> +#include <string.h> + +size_t hexstrtobin(const char *str, uint8_t *buf, size_t len) +{ + size_t count, ptr = 0; + uint8_t byte; + + for (byte = count = 0; str && *str; str++) { + uint8_t c = *str; + + if (!isxdigit(c)) + continue; + if (isdigit(c)) + c -= '0'; + else + c = tolower(c) - 'a' + 10; + + byte <<= 4; + byte |= c; + + if (++count > 1) { + if (ptr >= len) + return ptr; + buf[ptr++] = byte; + byte = count = 0; + } + } + + return ptr; +} |