diff options
Diffstat (limited to 'src')
| -rw-r--r-- | src/utils.c | 27 |
1 files changed, 27 insertions, 0 deletions
diff --git a/src/utils.c b/src/utils.c index 4dab0645..05381c8b 100644 --- a/src/utils.c +++ b/src/utils.c @@ -48,3 +48,30 @@ uint8_t char2bcd(char c) { return c - 0x30; } + +int hexparse(const char *str, uint8_t *b, int max_len) + +{ + int i, l, v; + + l = strlen(str); + if ((l&1) || ((l>>1) > max_len)) + return -1; + + memset(b, 0x00, max_len); + + for (i=0; i<l; i++) { + char c = str[i]; + if (c >= '0' && c <= '9') + v = c - '0'; + else if (c >= 'a' && c <= 'f') + v = 10 + (c - 'a'); + else if (c >= 'A' && c <= 'F') + v = 10 + (c - 'A'); + else + return -1; + b[i>>1] |= v << (i&1 ? 0 : 4); + } + + return i>>1; +} |