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
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
|
/* SPDX-License-Identifier: GPL-2.0-or-later */
#include <stdint.h>
#include <string.h>
#include <assert.h>
#include <commonlib/endian.h>
#include <console/console.h>
#include <delay.h>
#include <device/i2c_simple.h>
#include <endian.h>
#include <lib.h>
#include <security/tpm/tis.h>
#include "tpm.h"
/* global structure for tpm chip data */
static struct tpm_chip chip;
#define TPM_CMD_COUNT_BYTE 2
#define TPM_CMD_ORDINAL_BYTE 6
static ssize_t tpm_transmit(const uint8_t *sbuf, size_t sbufsiz, void *rbuf,
size_t rbufsiz)
{
int rc;
uint32_t count;
memcpy(&count, sbuf + TPM_CMD_COUNT_BYTE, sizeof(count));
count = be32_to_cpu(count);
if (!chip.send || !chip.status || !chip.cancel)
return -1;
if (count == 0) {
printk(BIOS_DEBUG, "%s: no data\n", __func__);
return -1;
}
if (count > sbufsiz) {
printk(BIOS_DEBUG, "%s: invalid count value %x %zx\n", __func__,
count, sbufsiz);
return -1;
}
ASSERT(chip.send);
rc = chip.send((uint8_t *)sbuf, count);
if (rc < 0) {
printk(BIOS_DEBUG, "%s: tpm_send error\n", __func__);
goto out;
}
int timeout = 2 * 60 * 1000; /* two minutes timeout */
while (timeout) {
ASSERT(chip.status);
uint8_t status = chip.status();
if ((status & chip.req_complete_mask) == chip.req_complete_val) {
goto out_recv;
}
if (status == chip.req_canceled) {
printk(BIOS_DEBUG,
"%s: Operation Canceled\n", __func__);
rc = -1;
goto out;
}
mdelay(TPM_TIMEOUT);
timeout--;
}
ASSERT(chip.cancel);
chip.cancel();
printk(BIOS_DEBUG, "%s: Operation Timed out\n", __func__);
rc = -1; //ETIME;
goto out;
out_recv:
rc = chip.recv((uint8_t *)rbuf, rbufsiz);
if (rc < 0)
printk(BIOS_DEBUG, "%s: tpm_recv: error %d\n", __func__, rc);
out:
return rc;
}
static int i2c_tpm_sendrecv(const uint8_t *sendbuf, size_t sbuf_size,
uint8_t *recvbuf, size_t *rbuf_len)
{
ASSERT(sbuf_size >= 10);
/* Display the TPM command */
if (CONFIG(DRIVER_TPM_DISPLAY_TIS_BYTES)) {
printk(BIOS_DEBUG, "TPM Command: 0x%08x\n",
read_at_be32(sendbuf, sizeof(uint16_t)
+ sizeof(uint32_t)));
hexdump(sendbuf, sbuf_size);
}
int len = tpm_transmit(sendbuf, sbuf_size, recvbuf, *rbuf_len);
if (len < 10) {
*rbuf_len = 0;
return -1;
}
if (len > *rbuf_len) {
*rbuf_len = len;
return -1;
}
*rbuf_len = len;
/* Display the TPM response */
if (CONFIG(DRIVER_TPM_DISPLAY_TIS_BYTES)) {
printk(BIOS_DEBUG, "TPM Response: 0x%08x\n",
read_at_be32(recvbuf, sizeof(uint16_t)
+ sizeof(uint32_t)));
hexdump(recvbuf, *rbuf_len);
}
return 0;
}
tis_sendrecv_fn tis_probe(void)
{
if (tpm_vendor_probe(CONFIG_DRIVER_TPM_I2C_BUS, CONFIG_DRIVER_TPM_I2C_ADDR))
return NULL;
if (tpm_vendor_init(&chip, CONFIG_DRIVER_TPM_I2C_BUS, CONFIG_DRIVER_TPM_I2C_ADDR))
return NULL;
return &i2c_tpm_sendrecv;
}
|
