aboutsummaryrefslogtreecommitdiff
path: root/core/tee/se/util.c
blob: 4bb44d0e0aa6089e3200aacd8d0b4a78d7e03033 (plain)
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
// SPDX-License-Identifier: BSD-2-Clause
/*
 * Copyright (c) 2014, Linaro Limited
 * All rights reserved.
 */

#include <tee_api_types.h>
#include <trace.h>
#include <tee/se/util.h>

#include <stdio.h>

char *print_buf(char *buf, size_t *remain_size, const char *fmt, ...)
{
	va_list ap;
	size_t len;

	va_start(ap, fmt);
	len = vsnprintf(buf, *remain_size, fmt, ap);
	buf += len;
	*remain_size -= len;
	va_end(ap);
	return buf;
}

void dump_hex(char *buf, size_t *remain_size, uint8_t *input_buf,
		size_t input_size)
{
	size_t i;

	for (i = 0; i < input_size; i++)
		buf = print_buf(buf, remain_size, "%02X ", input_buf[i]);
}

void print_hex(uint8_t *input_buf, size_t input_size)
{
	char buf[DUMP_BUF_MAX];
	size_t remain = sizeof(buf);

	dump_hex(buf, &remain, input_buf, input_size);
	DMSG("%s", buf);
}

uint8_t *hex_decode(const char *in, size_t len, uint8_t *out)
{
	size_t i, t, hn, ln;

	for (t = 0, i = 0; i < len; i += 2, ++t) {
		hn = in[i] > '9' ?
			(in[i] | 32) - 'a' + 10 : in[i] - '0';
		ln = in[i + 1] > '9' ?
			(in[i + 1] | 32) - 'a' + 10 : in[i + 1] - '0';

		out[t] = (hn << 4) | ln;
	}
	return out;
}