mirror of
https://github.com/brain-hackers/u-boot-brain
synced 2024-08-27 20:38:52 +09:00
![Simon Glass](/assets/img/avatar_default.png)
With TPM2 we don't actually lock the TPM once verified boot is finished. Instead we disable the platform hierarchy which serves the same purpose. Add an implementation of this so we can safely boot into the kernel. Signed-off-by: Simon Glass <sjg@chromium.org> Acked-by: Ilias Apalodimas <ilias.apalodimas@linaro.org>
662 lines
18 KiB
C
662 lines
18 KiB
C
// SPDX-License-Identifier: GPL-2.0+
|
|
/*
|
|
* Copyright (c) 2018 Bootlin
|
|
* Author: Miquel Raynal <miquel.raynal@bootlin.com>
|
|
*/
|
|
|
|
#include <common.h>
|
|
#include <dm.h>
|
|
#include <tpm-common.h>
|
|
#include <tpm-v2.h>
|
|
#include <linux/bitops.h>
|
|
#include "tpm-utils.h"
|
|
|
|
u32 tpm2_startup(struct udevice *dev, enum tpm2_startup_types mode)
|
|
{
|
|
const u8 command_v2[12] = {
|
|
tpm_u16(TPM2_ST_NO_SESSIONS),
|
|
tpm_u32(12),
|
|
tpm_u32(TPM2_CC_STARTUP),
|
|
tpm_u16(mode),
|
|
};
|
|
int ret;
|
|
|
|
/*
|
|
* Note TPM2_Startup command will return RC_SUCCESS the first time,
|
|
* but will return RC_INITIALIZE otherwise.
|
|
*/
|
|
ret = tpm_sendrecv_command(dev, command_v2, NULL, NULL);
|
|
if (ret && ret != TPM2_RC_INITIALIZE)
|
|
return ret;
|
|
|
|
return 0;
|
|
}
|
|
|
|
u32 tpm2_self_test(struct udevice *dev, enum tpm2_yes_no full_test)
|
|
{
|
|
const u8 command_v2[12] = {
|
|
tpm_u16(TPM2_ST_NO_SESSIONS),
|
|
tpm_u32(11),
|
|
tpm_u32(TPM2_CC_SELF_TEST),
|
|
full_test,
|
|
};
|
|
|
|
return tpm_sendrecv_command(dev, command_v2, NULL, NULL);
|
|
}
|
|
|
|
u32 tpm2_clear(struct udevice *dev, u32 handle, const char *pw,
|
|
const ssize_t pw_sz)
|
|
{
|
|
/* Length of the message header, up to start of password */
|
|
uint offset = 27;
|
|
u8 command_v2[COMMAND_BUFFER_SIZE] = {
|
|
tpm_u16(TPM2_ST_SESSIONS), /* TAG */
|
|
tpm_u32(offset + pw_sz), /* Length */
|
|
tpm_u32(TPM2_CC_CLEAR), /* Command code */
|
|
|
|
/* HANDLE */
|
|
tpm_u32(handle), /* TPM resource handle */
|
|
|
|
/* AUTH_SESSION */
|
|
tpm_u32(9 + pw_sz), /* Authorization size */
|
|
tpm_u32(TPM2_RS_PW), /* Session handle */
|
|
tpm_u16(0), /* Size of <nonce> */
|
|
/* <nonce> (if any) */
|
|
0, /* Attributes: Cont/Excl/Rst */
|
|
tpm_u16(pw_sz), /* Size of <hmac/password> */
|
|
/* STRING(pw) <hmac/password> (if any) */
|
|
};
|
|
int ret;
|
|
|
|
/*
|
|
* Fill the command structure starting from the first buffer:
|
|
* - the password (if any)
|
|
*/
|
|
ret = pack_byte_string(command_v2, sizeof(command_v2), "s",
|
|
offset, pw, pw_sz);
|
|
offset += pw_sz;
|
|
if (ret)
|
|
return TPM_LIB_ERROR;
|
|
|
|
return tpm_sendrecv_command(dev, command_v2, NULL, NULL);
|
|
}
|
|
|
|
u32 tpm2_nv_define_space(struct udevice *dev, u32 space_index,
|
|
size_t space_size, u32 nv_attributes,
|
|
const u8 *nv_policy, size_t nv_policy_size)
|
|
{
|
|
/*
|
|
* Calculate the offset of the nv_policy piece by adding each of the
|
|
* chunks below.
|
|
*/
|
|
uint offset = 10 + 8 + 13 + 14;
|
|
u8 command_v2[COMMAND_BUFFER_SIZE] = {
|
|
/* header 10 bytes */
|
|
tpm_u16(TPM2_ST_SESSIONS), /* TAG */
|
|
tpm_u32(offset + nv_policy_size),/* Length */
|
|
tpm_u32(TPM2_CC_NV_DEFINE_SPACE),/* Command code */
|
|
|
|
/* handles 8 bytes */
|
|
tpm_u32(TPM2_RH_PLATFORM), /* Primary platform seed */
|
|
|
|
/* session header 13 bytes */
|
|
tpm_u32(9), /* Header size */
|
|
tpm_u32(TPM2_RS_PW), /* Password authorisation */
|
|
tpm_u16(0), /* nonce_size */
|
|
0, /* session_attrs */
|
|
tpm_u16(0), /* auth_size */
|
|
|
|
/* message 14 bytes + policy */
|
|
tpm_u16(12 + nv_policy_size), /* size */
|
|
tpm_u32(space_index),
|
|
tpm_u16(TPM2_ALG_SHA256),
|
|
tpm_u32(nv_attributes),
|
|
tpm_u16(nv_policy_size),
|
|
/* nv_policy */
|
|
};
|
|
int ret;
|
|
|
|
/*
|
|
* Fill the command structure starting from the first buffer:
|
|
* - the password (if any)
|
|
*/
|
|
ret = pack_byte_string(command_v2, sizeof(command_v2), "s",
|
|
offset, nv_policy, nv_policy_size);
|
|
if (ret)
|
|
return TPM_LIB_ERROR;
|
|
|
|
return tpm_sendrecv_command(dev, command_v2, NULL, NULL);
|
|
}
|
|
|
|
u32 tpm2_pcr_extend(struct udevice *dev, u32 index, u32 algorithm,
|
|
const u8 *digest, u32 digest_len)
|
|
{
|
|
/* Length of the message header, up to start of digest */
|
|
uint offset = 33;
|
|
u8 command_v2[COMMAND_BUFFER_SIZE] = {
|
|
tpm_u16(TPM2_ST_SESSIONS), /* TAG */
|
|
tpm_u32(offset + digest_len), /* Length */
|
|
tpm_u32(TPM2_CC_PCR_EXTEND), /* Command code */
|
|
|
|
/* HANDLE */
|
|
tpm_u32(index), /* Handle (PCR Index) */
|
|
|
|
/* AUTH_SESSION */
|
|
tpm_u32(9), /* Authorization size */
|
|
tpm_u32(TPM2_RS_PW), /* Session handle */
|
|
tpm_u16(0), /* Size of <nonce> */
|
|
/* <nonce> (if any) */
|
|
0, /* Attributes: Cont/Excl/Rst */
|
|
tpm_u16(0), /* Size of <hmac/password> */
|
|
/* <hmac/password> (if any) */
|
|
|
|
/* hashes */
|
|
tpm_u32(1), /* Count (number of hashes) */
|
|
tpm_u16(algorithm), /* Algorithm of the hash */
|
|
/* STRING(digest) Digest */
|
|
};
|
|
int ret;
|
|
|
|
/*
|
|
* Fill the command structure starting from the first buffer:
|
|
* - the digest
|
|
*/
|
|
ret = pack_byte_string(command_v2, sizeof(command_v2), "s",
|
|
offset, digest, digest_len);
|
|
if (ret)
|
|
return TPM_LIB_ERROR;
|
|
|
|
return tpm_sendrecv_command(dev, command_v2, NULL, NULL);
|
|
}
|
|
|
|
u32 tpm2_nv_read_value(struct udevice *dev, u32 index, void *data, u32 count)
|
|
{
|
|
u8 command_v2[COMMAND_BUFFER_SIZE] = {
|
|
/* header 10 bytes */
|
|
tpm_u16(TPM2_ST_SESSIONS), /* TAG */
|
|
tpm_u32(10 + 8 + 4 + 9 + 4), /* Length */
|
|
tpm_u32(TPM2_CC_NV_READ), /* Command code */
|
|
|
|
/* handles 8 bytes */
|
|
tpm_u32(TPM2_RH_PLATFORM), /* Primary platform seed */
|
|
tpm_u32(HR_NV_INDEX + index), /* Password authorisation */
|
|
|
|
/* AUTH_SESSION */
|
|
tpm_u32(9), /* Authorization size */
|
|
tpm_u32(TPM2_RS_PW), /* Session handle */
|
|
tpm_u16(0), /* Size of <nonce> */
|
|
/* <nonce> (if any) */
|
|
0, /* Attributes: Cont/Excl/Rst */
|
|
tpm_u16(0), /* Size of <hmac/password> */
|
|
/* <hmac/password> (if any) */
|
|
|
|
tpm_u16(count), /* Number of bytes */
|
|
tpm_u16(0), /* Offset */
|
|
};
|
|
size_t response_len = COMMAND_BUFFER_SIZE;
|
|
u8 response[COMMAND_BUFFER_SIZE];
|
|
int ret;
|
|
u16 tag;
|
|
u32 size, code;
|
|
|
|
ret = tpm_sendrecv_command(dev, command_v2, response, &response_len);
|
|
if (ret)
|
|
return log_msg_ret("read", ret);
|
|
if (unpack_byte_string(response, response_len, "wdds",
|
|
0, &tag, 2, &size, 6, &code,
|
|
16, data, count))
|
|
return TPM_LIB_ERROR;
|
|
|
|
return 0;
|
|
}
|
|
|
|
u32 tpm2_nv_write_value(struct udevice *dev, u32 index, const void *data,
|
|
u32 count)
|
|
{
|
|
struct tpm_chip_priv *priv = dev_get_uclass_priv(dev);
|
|
uint offset = 10 + 8 + 4 + 9 + 2;
|
|
uint len = offset + count + 2;
|
|
/* Use empty password auth if platform hierarchy is disabled */
|
|
u32 auth = priv->plat_hier_disabled ? HR_NV_INDEX + index :
|
|
TPM2_RH_PLATFORM;
|
|
u8 command_v2[COMMAND_BUFFER_SIZE] = {
|
|
/* header 10 bytes */
|
|
tpm_u16(TPM2_ST_SESSIONS), /* TAG */
|
|
tpm_u32(len), /* Length */
|
|
tpm_u32(TPM2_CC_NV_WRITE), /* Command code */
|
|
|
|
/* handles 8 bytes */
|
|
tpm_u32(auth), /* Primary platform seed */
|
|
tpm_u32(HR_NV_INDEX + index), /* Password authorisation */
|
|
|
|
/* AUTH_SESSION */
|
|
tpm_u32(9), /* Authorization size */
|
|
tpm_u32(TPM2_RS_PW), /* Session handle */
|
|
tpm_u16(0), /* Size of <nonce> */
|
|
/* <nonce> (if any) */
|
|
0, /* Attributes: Cont/Excl/Rst */
|
|
tpm_u16(0), /* Size of <hmac/password> */
|
|
/* <hmac/password> (if any) */
|
|
|
|
tpm_u16(count),
|
|
};
|
|
size_t response_len = COMMAND_BUFFER_SIZE;
|
|
u8 response[COMMAND_BUFFER_SIZE];
|
|
int ret;
|
|
|
|
ret = pack_byte_string(command_v2, sizeof(command_v2), "sw",
|
|
offset, data, count,
|
|
offset + count, 0);
|
|
if (ret)
|
|
return TPM_LIB_ERROR;
|
|
|
|
return tpm_sendrecv_command(dev, command_v2, response, &response_len);
|
|
}
|
|
|
|
u32 tpm2_pcr_read(struct udevice *dev, u32 idx, unsigned int idx_min_sz,
|
|
void *data, unsigned int *updates)
|
|
{
|
|
u8 idx_array_sz = max(idx_min_sz, DIV_ROUND_UP(idx, 8));
|
|
u8 command_v2[COMMAND_BUFFER_SIZE] = {
|
|
tpm_u16(TPM2_ST_NO_SESSIONS), /* TAG */
|
|
tpm_u32(17 + idx_array_sz), /* Length */
|
|
tpm_u32(TPM2_CC_PCR_READ), /* Command code */
|
|
|
|
/* TPML_PCR_SELECTION */
|
|
tpm_u32(1), /* Number of selections */
|
|
tpm_u16(TPM2_ALG_SHA256), /* Algorithm of the hash */
|
|
idx_array_sz, /* Array size for selection */
|
|
/* bitmap(idx) Selected PCR bitmap */
|
|
};
|
|
size_t response_len = COMMAND_BUFFER_SIZE;
|
|
u8 response[COMMAND_BUFFER_SIZE];
|
|
unsigned int pcr_sel_idx = idx / 8;
|
|
u8 pcr_sel_bit = BIT(idx % 8);
|
|
unsigned int counter = 0;
|
|
int ret;
|
|
|
|
if (pack_byte_string(command_v2, COMMAND_BUFFER_SIZE, "b",
|
|
17 + pcr_sel_idx, pcr_sel_bit))
|
|
return TPM_LIB_ERROR;
|
|
|
|
ret = tpm_sendrecv_command(dev, command_v2, response, &response_len);
|
|
if (ret)
|
|
return ret;
|
|
|
|
if (unpack_byte_string(response, response_len, "ds",
|
|
10, &counter,
|
|
response_len - TPM2_DIGEST_LEN, data,
|
|
TPM2_DIGEST_LEN))
|
|
return TPM_LIB_ERROR;
|
|
|
|
if (updates)
|
|
*updates = counter;
|
|
|
|
return 0;
|
|
}
|
|
|
|
u32 tpm2_get_capability(struct udevice *dev, u32 capability, u32 property,
|
|
void *buf, size_t prop_count)
|
|
{
|
|
u8 command_v2[COMMAND_BUFFER_SIZE] = {
|
|
tpm_u16(TPM2_ST_NO_SESSIONS), /* TAG */
|
|
tpm_u32(22), /* Length */
|
|
tpm_u32(TPM2_CC_GET_CAPABILITY), /* Command code */
|
|
|
|
tpm_u32(capability), /* Capability */
|
|
tpm_u32(property), /* Property */
|
|
tpm_u32(prop_count), /* Property count */
|
|
};
|
|
u8 response[COMMAND_BUFFER_SIZE];
|
|
size_t response_len = COMMAND_BUFFER_SIZE;
|
|
unsigned int properties_off;
|
|
int ret;
|
|
|
|
ret = tpm_sendrecv_command(dev, command_v2, response, &response_len);
|
|
if (ret)
|
|
return ret;
|
|
|
|
/*
|
|
* In the response buffer, the properties are located after the:
|
|
* tag (u16), response size (u32), response code (u32),
|
|
* YES/NO flag (u8), TPM_CAP (u32).
|
|
*/
|
|
properties_off = sizeof(u16) + sizeof(u32) + sizeof(u32) +
|
|
sizeof(u8) + sizeof(u32);
|
|
memcpy(buf, &response[properties_off], response_len - properties_off);
|
|
|
|
return 0;
|
|
}
|
|
|
|
u32 tpm2_dam_reset(struct udevice *dev, const char *pw, const ssize_t pw_sz)
|
|
{
|
|
u8 command_v2[COMMAND_BUFFER_SIZE] = {
|
|
tpm_u16(TPM2_ST_SESSIONS), /* TAG */
|
|
tpm_u32(27 + pw_sz), /* Length */
|
|
tpm_u32(TPM2_CC_DAM_RESET), /* Command code */
|
|
|
|
/* HANDLE */
|
|
tpm_u32(TPM2_RH_LOCKOUT), /* TPM resource handle */
|
|
|
|
/* AUTH_SESSION */
|
|
tpm_u32(9 + pw_sz), /* Authorization size */
|
|
tpm_u32(TPM2_RS_PW), /* Session handle */
|
|
tpm_u16(0), /* Size of <nonce> */
|
|
/* <nonce> (if any) */
|
|
0, /* Attributes: Cont/Excl/Rst */
|
|
tpm_u16(pw_sz), /* Size of <hmac/password> */
|
|
/* STRING(pw) <hmac/password> (if any) */
|
|
};
|
|
unsigned int offset = 27;
|
|
int ret;
|
|
|
|
/*
|
|
* Fill the command structure starting from the first buffer:
|
|
* - the password (if any)
|
|
*/
|
|
ret = pack_byte_string(command_v2, sizeof(command_v2), "s",
|
|
offset, pw, pw_sz);
|
|
offset += pw_sz;
|
|
if (ret)
|
|
return TPM_LIB_ERROR;
|
|
|
|
return tpm_sendrecv_command(dev, command_v2, NULL, NULL);
|
|
}
|
|
|
|
u32 tpm2_dam_parameters(struct udevice *dev, const char *pw,
|
|
const ssize_t pw_sz, unsigned int max_tries,
|
|
unsigned int recovery_time,
|
|
unsigned int lockout_recovery)
|
|
{
|
|
u8 command_v2[COMMAND_BUFFER_SIZE] = {
|
|
tpm_u16(TPM2_ST_SESSIONS), /* TAG */
|
|
tpm_u32(27 + pw_sz + 12), /* Length */
|
|
tpm_u32(TPM2_CC_DAM_PARAMETERS), /* Command code */
|
|
|
|
/* HANDLE */
|
|
tpm_u32(TPM2_RH_LOCKOUT), /* TPM resource handle */
|
|
|
|
/* AUTH_SESSION */
|
|
tpm_u32(9 + pw_sz), /* Authorization size */
|
|
tpm_u32(TPM2_RS_PW), /* Session handle */
|
|
tpm_u16(0), /* Size of <nonce> */
|
|
/* <nonce> (if any) */
|
|
0, /* Attributes: Cont/Excl/Rst */
|
|
tpm_u16(pw_sz), /* Size of <hmac/password> */
|
|
/* STRING(pw) <hmac/password> (if any) */
|
|
|
|
/* LOCKOUT PARAMETERS */
|
|
/* tpm_u32(max_tries) Max tries (0, always lock) */
|
|
/* tpm_u32(recovery_time) Recovery time (0, no lock) */
|
|
/* tpm_u32(lockout_recovery) Lockout recovery */
|
|
};
|
|
unsigned int offset = 27;
|
|
int ret;
|
|
|
|
/*
|
|
* Fill the command structure starting from the first buffer:
|
|
* - the password (if any)
|
|
* - max tries
|
|
* - recovery time
|
|
* - lockout recovery
|
|
*/
|
|
ret = pack_byte_string(command_v2, sizeof(command_v2), "sddd",
|
|
offset, pw, pw_sz,
|
|
offset + pw_sz, max_tries,
|
|
offset + pw_sz + 4, recovery_time,
|
|
offset + pw_sz + 8, lockout_recovery);
|
|
offset += pw_sz + 12;
|
|
if (ret)
|
|
return TPM_LIB_ERROR;
|
|
|
|
return tpm_sendrecv_command(dev, command_v2, NULL, NULL);
|
|
}
|
|
|
|
int tpm2_change_auth(struct udevice *dev, u32 handle, const char *newpw,
|
|
const ssize_t newpw_sz, const char *oldpw,
|
|
const ssize_t oldpw_sz)
|
|
{
|
|
unsigned int offset = 27;
|
|
u8 command_v2[COMMAND_BUFFER_SIZE] = {
|
|
tpm_u16(TPM2_ST_SESSIONS), /* TAG */
|
|
tpm_u32(offset + oldpw_sz + 2 + newpw_sz), /* Length */
|
|
tpm_u32(TPM2_CC_HIERCHANGEAUTH), /* Command code */
|
|
|
|
/* HANDLE */
|
|
tpm_u32(handle), /* TPM resource handle */
|
|
|
|
/* AUTH_SESSION */
|
|
tpm_u32(9 + oldpw_sz), /* Authorization size */
|
|
tpm_u32(TPM2_RS_PW), /* Session handle */
|
|
tpm_u16(0), /* Size of <nonce> */
|
|
/* <nonce> (if any) */
|
|
0, /* Attributes: Cont/Excl/Rst */
|
|
tpm_u16(oldpw_sz) /* Size of <hmac/password> */
|
|
/* STRING(oldpw) <hmac/password> (if any) */
|
|
|
|
/* TPM2B_AUTH (TPM2B_DIGEST) */
|
|
/* tpm_u16(newpw_sz) Digest size, new pw length */
|
|
/* STRING(newpw) Digest buffer, new pw */
|
|
};
|
|
int ret;
|
|
|
|
/*
|
|
* Fill the command structure starting from the first buffer:
|
|
* - the old password (if any)
|
|
* - size of the new password
|
|
* - new password
|
|
*/
|
|
ret = pack_byte_string(command_v2, sizeof(command_v2), "sws",
|
|
offset, oldpw, oldpw_sz,
|
|
offset + oldpw_sz, newpw_sz,
|
|
offset + oldpw_sz + 2, newpw, newpw_sz);
|
|
offset += oldpw_sz + 2 + newpw_sz;
|
|
if (ret)
|
|
return TPM_LIB_ERROR;
|
|
|
|
return tpm_sendrecv_command(dev, command_v2, NULL, NULL);
|
|
}
|
|
|
|
u32 tpm2_pcr_setauthpolicy(struct udevice *dev, const char *pw,
|
|
const ssize_t pw_sz, u32 index, const char *key)
|
|
{
|
|
u8 command_v2[COMMAND_BUFFER_SIZE] = {
|
|
tpm_u16(TPM2_ST_SESSIONS), /* TAG */
|
|
tpm_u32(35 + pw_sz + TPM2_DIGEST_LEN), /* Length */
|
|
tpm_u32(TPM2_CC_PCR_SETAUTHPOL), /* Command code */
|
|
|
|
/* HANDLE */
|
|
tpm_u32(TPM2_RH_PLATFORM), /* TPM resource handle */
|
|
|
|
/* AUTH_SESSION */
|
|
tpm_u32(9 + pw_sz), /* Authorization size */
|
|
tpm_u32(TPM2_RS_PW), /* session handle */
|
|
tpm_u16(0), /* Size of <nonce> */
|
|
/* <nonce> (if any) */
|
|
0, /* Attributes: Cont/Excl/Rst */
|
|
tpm_u16(pw_sz) /* Size of <hmac/password> */
|
|
/* STRING(pw) <hmac/password> (if any) */
|
|
|
|
/* TPM2B_AUTH (TPM2B_DIGEST) */
|
|
/* tpm_u16(TPM2_DIGEST_LEN) Digest size length */
|
|
/* STRING(key) Digest buffer (PCR key) */
|
|
|
|
/* TPMI_ALG_HASH */
|
|
/* tpm_u16(TPM2_ALG_SHA256) Algorithm of the hash */
|
|
|
|
/* TPMI_DH_PCR */
|
|
/* tpm_u32(index), PCR Index */
|
|
};
|
|
unsigned int offset = 27;
|
|
int ret;
|
|
|
|
/*
|
|
* Fill the command structure starting from the first buffer:
|
|
* - the password (if any)
|
|
* - the PCR key length
|
|
* - the PCR key
|
|
* - the hash algorithm
|
|
* - the PCR index
|
|
*/
|
|
ret = pack_byte_string(command_v2, sizeof(command_v2), "swswd",
|
|
offset, pw, pw_sz,
|
|
offset + pw_sz, TPM2_DIGEST_LEN,
|
|
offset + pw_sz + 2, key, TPM2_DIGEST_LEN,
|
|
offset + pw_sz + 2 + TPM2_DIGEST_LEN,
|
|
TPM2_ALG_SHA256,
|
|
offset + pw_sz + 4 + TPM2_DIGEST_LEN, index);
|
|
offset += pw_sz + 2 + TPM2_DIGEST_LEN + 2 + 4;
|
|
if (ret)
|
|
return TPM_LIB_ERROR;
|
|
|
|
return tpm_sendrecv_command(dev, command_v2, NULL, NULL);
|
|
}
|
|
|
|
u32 tpm2_pcr_setauthvalue(struct udevice *dev, const char *pw,
|
|
const ssize_t pw_sz, u32 index, const char *key,
|
|
const ssize_t key_sz)
|
|
{
|
|
u8 command_v2[COMMAND_BUFFER_SIZE] = {
|
|
tpm_u16(TPM2_ST_SESSIONS), /* TAG */
|
|
tpm_u32(33 + pw_sz + TPM2_DIGEST_LEN), /* Length */
|
|
tpm_u32(TPM2_CC_PCR_SETAUTHVAL), /* Command code */
|
|
|
|
/* HANDLE */
|
|
tpm_u32(index), /* Handle (PCR Index) */
|
|
|
|
/* AUTH_SESSION */
|
|
tpm_u32(9 + pw_sz), /* Authorization size */
|
|
tpm_u32(TPM2_RS_PW), /* session handle */
|
|
tpm_u16(0), /* Size of <nonce> */
|
|
/* <nonce> (if any) */
|
|
0, /* Attributes: Cont/Excl/Rst */
|
|
tpm_u16(pw_sz), /* Size of <hmac/password> */
|
|
/* STRING(pw) <hmac/password> (if any) */
|
|
|
|
/* TPM2B_DIGEST */
|
|
/* tpm_u16(key_sz) Key length */
|
|
/* STRING(key) Key */
|
|
};
|
|
unsigned int offset = 27;
|
|
int ret;
|
|
|
|
/*
|
|
* Fill the command structure starting from the first buffer:
|
|
* - the password (if any)
|
|
* - the number of digests, 1 in our case
|
|
* - the algorithm, sha256 in our case
|
|
* - the digest (64 bytes)
|
|
*/
|
|
ret = pack_byte_string(command_v2, sizeof(command_v2), "sws",
|
|
offset, pw, pw_sz,
|
|
offset + pw_sz, key_sz,
|
|
offset + pw_sz + 2, key, key_sz);
|
|
offset += pw_sz + 2 + key_sz;
|
|
if (ret)
|
|
return TPM_LIB_ERROR;
|
|
|
|
return tpm_sendrecv_command(dev, command_v2, NULL, NULL);
|
|
}
|
|
|
|
u32 tpm2_get_random(struct udevice *dev, void *data, u32 count)
|
|
{
|
|
const u8 command_v2[10] = {
|
|
tpm_u16(TPM2_ST_NO_SESSIONS),
|
|
tpm_u32(12),
|
|
tpm_u32(TPM2_CC_GET_RANDOM),
|
|
};
|
|
u8 buf[COMMAND_BUFFER_SIZE], response[COMMAND_BUFFER_SIZE];
|
|
|
|
const size_t data_size_offset = 10;
|
|
const size_t data_offset = 12;
|
|
size_t response_length = sizeof(response);
|
|
u32 data_size;
|
|
u8 *out = data;
|
|
|
|
while (count > 0) {
|
|
u32 this_bytes = min((size_t)count,
|
|
sizeof(response) - data_offset);
|
|
u32 err;
|
|
|
|
if (pack_byte_string(buf, sizeof(buf), "sw",
|
|
0, command_v2, sizeof(command_v2),
|
|
sizeof(command_v2), this_bytes))
|
|
return TPM_LIB_ERROR;
|
|
err = tpm_sendrecv_command(dev, buf, response,
|
|
&response_length);
|
|
if (err)
|
|
return err;
|
|
if (unpack_byte_string(response, response_length, "w",
|
|
data_size_offset, &data_size))
|
|
return TPM_LIB_ERROR;
|
|
if (data_size > this_bytes)
|
|
return TPM_LIB_ERROR;
|
|
if (unpack_byte_string(response, response_length, "s",
|
|
data_offset, out, data_size))
|
|
return TPM_LIB_ERROR;
|
|
|
|
count -= data_size;
|
|
out += data_size;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
u32 tpm2_write_lock(struct udevice *dev, u32 index)
|
|
{
|
|
u8 command_v2[COMMAND_BUFFER_SIZE] = {
|
|
/* header 10 bytes */
|
|
tpm_u16(TPM2_ST_SESSIONS), /* TAG */
|
|
tpm_u32(10 + 8 + 13), /* Length */
|
|
tpm_u32(TPM2_CC_NV_WRITELOCK), /* Command code */
|
|
|
|
/* handles 8 bytes */
|
|
tpm_u32(TPM2_RH_PLATFORM), /* Primary platform seed */
|
|
tpm_u32(HR_NV_INDEX + index), /* Password authorisation */
|
|
|
|
/* session header 9 bytes */
|
|
tpm_u32(9), /* Header size */
|
|
tpm_u32(TPM2_RS_PW), /* Password authorisation */
|
|
tpm_u16(0), /* nonce_size */
|
|
0, /* session_attrs */
|
|
tpm_u16(0), /* auth_size */
|
|
};
|
|
|
|
return tpm_sendrecv_command(dev, command_v2, NULL, NULL);
|
|
}
|
|
|
|
u32 tpm2_disable_platform_hierarchy(struct udevice *dev)
|
|
{
|
|
struct tpm_chip_priv *priv = dev_get_uclass_priv(dev);
|
|
u8 command_v2[COMMAND_BUFFER_SIZE] = {
|
|
/* header 10 bytes */
|
|
tpm_u16(TPM2_ST_SESSIONS), /* TAG */
|
|
tpm_u32(10 + 4 + 13 + 5), /* Length */
|
|
tpm_u32(TPM2_CC_HIER_CONTROL), /* Command code */
|
|
|
|
/* 4 bytes */
|
|
tpm_u32(TPM2_RH_PLATFORM), /* Primary platform seed */
|
|
|
|
/* session header 9 bytes */
|
|
tpm_u32(9), /* Header size */
|
|
tpm_u32(TPM2_RS_PW), /* Password authorisation */
|
|
tpm_u16(0), /* nonce_size */
|
|
0, /* session_attrs */
|
|
tpm_u16(0), /* auth_size */
|
|
|
|
/* payload 5 bytes */
|
|
tpm_u32(TPM2_RH_PLATFORM), /* Hierarchy to disable */
|
|
0, /* 0=disable */
|
|
};
|
|
int ret;
|
|
|
|
ret = tpm_sendrecv_command(dev, command_v2, NULL, NULL);
|
|
log_info("ret=%s, %x\n", dev->name, ret);
|
|
if (ret)
|
|
return ret;
|
|
|
|
priv->plat_hier_disabled = true;
|
|
|
|
return 0;
|
|
}
|