[thirdparty/u-boot.git] / lib / tpm-common.c

// SPDX-License-Identifier: GPL-2.0+
/*
 * Copyright (c) 2013 The Chromium OS Authors.
 * Coypright (c) 2013 Guntermann & Drunck GmbH
 */

#define LOG_CATEGORY UCLASS_TPM

#include <common.h>
#include <dm.h>
#include <log.h>
#include <asm/unaligned.h>
#include <tpm-common.h>
#include "tpm-utils.h"

enum tpm_version tpm_get_version(struct udevice *dev)
{
	struct tpm_chip_priv *priv = dev_get_uclass_priv(dev);

	return priv->version;
}

int pack_byte_string(u8 *str, size_t size, const char *format, ...)
{
	va_list args;
	size_t offset = 0, length = 0;
	u8 *data = NULL;
	u32 value = 0;

	va_start(args, format);
	for (; *format; format++) {
		switch (*format) {
		case 'b':
			offset = va_arg(args, size_t);
			value = va_arg(args, int);
			length = 1;
			break;
		case 'w':
			offset = va_arg(args, size_t);
			value = va_arg(args, int);
			length = 2;
			break;
		case 'd':
			offset = va_arg(args, size_t);
			value = va_arg(args, u32);
			length = 4;
			break;
		case 's':
			offset = va_arg(args, size_t);
			data = va_arg(args, u8 *);
			length = va_arg(args, u32);
			break;
		default:
			debug("Couldn't recognize format string\n");
			va_end(args);
			return -1;
		}

		if (offset + length > size) {
			va_end(args);
			return -1;
		}

		switch (*format) {
		case 'b':
			str[offset] = value;
			break;
		case 'w':
			put_unaligned_be16(value, str + offset);
			break;
		case 'd':
			put_unaligned_be32(value, str + offset);
			break;
		case 's':
			memcpy(str + offset, data, length);
			break;
		}
	}
	va_end(args);

	return 0;
}

int unpack_byte_string(const u8 *str, size_t size, const char *format, ...)
{
	va_list args;
	size_t offset = 0, length = 0;
	u8 *ptr8 = NULL;
	u16 *ptr16 = NULL;
	u32 *ptr32 = NULL;

	va_start(args, format);
	for (; *format; format++) {
		switch (*format) {
		case 'b':
			offset = va_arg(args, size_t);
			ptr8 = va_arg(args, u8 *);
			length = 1;
			break;
		case 'w':
			offset = va_arg(args, size_t);
			ptr16 = va_arg(args, u16 *);
			length = 2;
			break;
		case 'd':
			offset = va_arg(args, size_t);
			ptr32 = va_arg(args, u32 *);
			length = 4;
			break;
		case 's':
			offset = va_arg(args, size_t);
			ptr8 = va_arg(args, u8 *);
			length = va_arg(args, u32);
			break;
		default:
			va_end(args);
			debug("Couldn't recognize format string\n");
			return -1;
		}

		if (offset + length > size) {
			va_end(args);
			log_err("Failed to read: size=%zd, offset=%zx, len=%zx\n",
				size, offset, length);
			return -1;
		}

		switch (*format) {
		case 'b':
			*ptr8 = str[offset];
			break;
		case 'w':
			*ptr16 = get_unaligned_be16(str + offset);
			break;
		case 'd':
			*ptr32 = get_unaligned_be32(str + offset);
			break;
		case 's':
			memcpy(ptr8, str + offset, length);
			break;
		}
	}
	va_end(args);

	return 0;
}

u32 tpm_command_size(const void *command)
{
	const size_t command_size_offset = 2;

	return get_unaligned_be32(command + command_size_offset);
}

u32 tpm_return_code(const void *response)
{
	const size_t return_code_offset = 6;

	return get_unaligned_be32(response + return_code_offset);
}

u32 tpm_sendrecv_command(struct udevice *dev, const void *command,
			 void *response, size_t *size_ptr)
{
	int err, ret;
	u8 response_buffer[COMMAND_BUFFER_SIZE];
	size_t response_length;
	int i;

	if (response) {
		response_length = *size_ptr;
	} else {
		response = response_buffer;
		response_length = sizeof(response_buffer);
	}

	err = tpm_xfer(dev, command, tpm_command_size(command),
		       response, &response_length);

	if (err < 0)
		return err;

	if (size_ptr)
		*size_ptr = response_length;

	ret = tpm_return_code(response);

	log_debug("TPM response [ret:%d]: ", ret);
	for (i = 0; i < response_length; i++)
		log_debug("%02x ", ((u8 *)response)[i]);
	log_debug("\n");

	return ret;
}

int tpm_init(struct udevice *dev)
{
	return tpm_open(dev);
}
Commit	Line	Data
d677bfe2 MR	1	// SPDX-License-Identifier: GPL-2.0+
	2	/*
	3	* Copyright (c) 2013 The Chromium OS Authors.
	4	* Coypright (c) 2013 Guntermann & Drunck GmbH
	5	*/
	6
34a5e8a2 SG	7	#define LOG_CATEGORY UCLASS_TPM
34a5e8a2 SG	8
d677bfe2 MR	9	#include <common.h>
d677bfe2 MR	10	#include <dm.h>
f7ae49fc	11	#include <log.h>
d677bfe2 MR	12	#include <asm/unaligned.h>
	13	#include <tpm-common.h>
	14	#include "tpm-utils.h"
	15
0a60a0a6 SG	16	enum tpm_version tpm_get_version(struct udevice *dev)
	17	{
	18	struct tpm_chip_priv *priv = dev_get_uclass_priv(dev);
	19
	20	return priv->version;
	21	}
	22
d677bfe2 MR	23	int pack_byte_string(u8 str, size_t size, const char format, ...)
	24	{
	25	va_list args;
	26	size_t offset = 0, length = 0;
	27	u8 *data = NULL;
	28	u32 value = 0;
	29
	30	va_start(args, format);
	31	for (; *format; format++) {
	32	switch (*format) {
	33	case 'b':
	34	offset = va_arg(args, size_t);
	35	value = va_arg(args, int);
	36	length = 1;
	37	break;
	38	case 'w':
	39	offset = va_arg(args, size_t);
	40	value = va_arg(args, int);
	41	length = 2;
	42	break;
	43	case 'd':
	44	offset = va_arg(args, size_t);
	45	value = va_arg(args, u32);
	46	length = 4;
	47	break;
	48	case 's':
	49	offset = va_arg(args, size_t);
	50	data = va_arg(args, u8 *);
	51	length = va_arg(args, u32);
	52	break;
	53	default:
	54	debug("Couldn't recognize format string\n");
	55	va_end(args);
	56	return -1;
	57	}
	58
	59	if (offset + length > size) {
	60	va_end(args);
	61	return -1;
	62	}
	63
	64	switch (*format) {
	65	case 'b':
	66	str[offset] = value;
	67	break;
	68	case 'w':
	69	put_unaligned_be16(value, str + offset);
	70	break;
	71	case 'd':
	72	put_unaligned_be32(value, str + offset);
	73	break;
	74	case 's':
	75	memcpy(str + offset, data, length);
	76	break;
	77	}
	78	}
	79	va_end(args);
	80
	81	return 0;
	82	}
	83
	84	int unpack_byte_string(const u8 str, size_t size, const char format, ...)
	85	{
	86	va_list args;
87	size_t offset = 0, length = 0;
88	u8 *ptr8 = NULL;
89	u16 *ptr16 = NULL;
90	u32 *ptr32 = NULL;
91
92	va_start(args, format);
93	for (; *format; format++) {
94	switch (*format) {
95	case 'b':
96	offset = va_arg(args, size_t);
97	ptr8 = va_arg(args, u8 *);
98	length = 1;
99	break;
100	case 'w':
101	offset = va_arg(args, size_t);
102	ptr16 = va_arg(args, u16 *);
103	length = 2;
104	break;
105	case 'd':
106	offset = va_arg(args, size_t);
107	ptr32 = va_arg(args, u32 *);
108	length = 4;
109	break;
110	case 's':
111	offset = va_arg(args, size_t);
112	ptr8 = va_arg(args, u8 *);
113	length = va_arg(args, u32);
114	break;
115	default:
116	va_end(args);
117	debug("Couldn't recognize format string\n");
118	return -1;
119	}
120
121	if (offset + length > size) {
122	va_end(args);
5092af6b	123	log_err("Failed to read: size=%zd, offset=%zx, len=%zx\n",
34a5e8a2	124	size, offset, length);
d677bfe2 MR	125	return -1;
	126	}
	127
	128	switch (*format) {
	129	case 'b':
	130	*ptr8 = str[offset];
	131	break;
	132	case 'w':
	133	*ptr16 = get_unaligned_be16(str + offset);
	134	break;
	135	case 'd':
	136	*ptr32 = get_unaligned_be32(str + offset);
	137	break;
	138	case 's':
	139	memcpy(ptr8, str + offset, length);
	140	break;
	141	}
	142	}
	143	va_end(args);
	144
	145	return 0;
	146	}
	147
	148	u32 tpm_command_size(const void *command)
	149	{
	150	const size_t command_size_offset = 2;
	151
	152	return get_unaligned_be32(command + command_size_offset);
	153	}
	154
	155	u32 tpm_return_code(const void *response)
	156	{
	157	const size_t return_code_offset = 6;
	158
	159	return get_unaligned_be32(response + return_code_offset);
	160	}
	161
abdc7b8a SG	162	u32 tpm_sendrecv_command(struct udevice dev, const void command,
abdc7b8a SG	163	void response, size_t size_ptr)
d677bfe2	164	{
d677bfe2 MR	165	int err, ret;
	166	u8 response_buffer[COMMAND_BUFFER_SIZE];
	167	size_t response_length;
aa643013	168	int i;
d677bfe2 MR	169
	170	if (response) {
	171	response_length = *size_ptr;
	172	} else {
	173	response = response_buffer;
	174	response_length = sizeof(response_buffer);
	175	}
	176
d677bfe2 MR	177	err = tpm_xfer(dev, command, tpm_command_size(command),
	178	response, &response_length);
	179
	180	if (err < 0)
bcdf6b9f MR	181	return err;
bcdf6b9f MR	182
d677bfe2 MR	183	if (size_ptr)
	184	*size_ptr = response_length;
	185
aa643013 MR	186	ret = tpm_return_code(response);
aa643013 MR	187
34a5e8a2	188	log_debug("TPM response [ret:%d]: ", ret);
aa643013	189	for (i = 0; i < response_length; i++)
34a5e8a2 SG	190	log_debug("%02x ", ((u8 *)response)[i]);
34a5e8a2 SG	191	log_debug("\n");
aa643013 MR	192
aa643013 MR	193	return ret;
d677bfe2 MR	194	}
d677bfe2 MR	195
abdc7b8a	196	int tpm_init(struct udevice *dev)
d677bfe2	197	{
d677bfe2 MR	198	return tpm_open(dev);
d677bfe2 MR	199	}