| // 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; |
| } |