1
2
3
4
5
6#include <common.h>
7#include <tee.h>
8#include <broadcom/chimp.h>
9
10#ifdef CONFIG_CHIMP_OPTEE
11
12#define CHMIP_BOOT_UUID { 0x6272636D, 0x2019, 0x0716, \
13 { 0x42, 0x43, 0x4D, 0x5F, 0x53, 0x43, 0x48, 0x49 } }
14
15enum {
16 TEE_CHIMP_FASTBOOT = 0,
17 TEE_CHIMP_HEALTH_STATUS,
18 TEE_CHIMP_HANDSHAKE_STATUS,
19} tee_chmip_cmd;
20
21struct bcm_chimp_data {
22 struct udevice *tee;
23 u32 session;
24} chimp_data;
25
26static int get_open_session(struct bcm_chimp_data *b_data)
27{
28 const struct tee_optee_ta_uuid uuid = CHMIP_BOOT_UUID;
29 struct tee_open_session_arg arg;
30 struct udevice *tee = NULL;
31 int rc;
32
33 tee = tee_find_device(NULL, NULL, NULL, NULL);
34 if (!tee)
35 return -ENODEV;
36
37 memset(&arg, 0, sizeof(arg));
38 tee_optee_ta_uuid_to_octets(arg.uuid, &uuid);
39 rc = tee_open_session(tee, &arg, 0, NULL);
40 if (rc < 0)
41 return -ENODEV;
42
43 b_data->tee = tee;
44 b_data->session = arg.session;
45
46 return 0;
47}
48
49static int init_arg(struct tee_invoke_arg *arg, u32 func)
50{
51 if (get_open_session(&chimp_data))
52 return -EINVAL;
53
54 memset(arg, 0, sizeof(struct tee_invoke_arg));
55 arg->func = func;
56 arg->session = chimp_data.session;
57
58 return 0;
59}
60
61int chimp_handshake_status_optee(u32 timeout, u32 *hs)
62{
63 struct tee_invoke_arg arg;
64 struct tee_param param[1];
65 int ret;
66
67 ret = init_arg(&arg, TEE_CHIMP_HANDSHAKE_STATUS);
68 if (ret < 0)
69 return ret;
70
71 param[0].attr = TEE_PARAM_ATTR_TYPE_VALUE_INOUT;
72 param[0].u.value.a = timeout;
73
74 ret = tee_invoke_func(chimp_data.tee, &arg, ARRAY_SIZE(param), param);
75 if (ret < 0) {
76 printf("Handshake status command failed\n");
77 goto out;
78 }
79
80 switch (arg.ret) {
81 case TEE_SUCCESS:
82 *hs = param[0].u.value.a;
83 ret = 0;
84 break;
85 default:
86 ret = -EINVAL;
87 break;
88 }
89
90out:
91 tee_close_session(chimp_data.tee, chimp_data.session);
92 chimp_data.tee = NULL;
93
94 return ret;
95}
96
97int chimp_health_status_optee(u32 *health)
98{
99 struct tee_invoke_arg arg;
100 struct tee_param param[1];
101 int ret;
102
103 ret = init_arg(&arg, TEE_CHIMP_HEALTH_STATUS);
104 if (ret < 0)
105 return ret;
106
107 param[0].attr = TEE_PARAM_ATTR_TYPE_VALUE_OUTPUT;
108
109 ret = tee_invoke_func(chimp_data.tee, &arg, ARRAY_SIZE(param), param);
110 if (ret < 0) {
111 printf("Helath status command failed\n");
112 goto out;
113 }
114
115 switch (arg.ret) {
116 case TEE_SUCCESS:
117 *health = param[0].u.value.a;
118 ret = 0;
119 break;
120 default:
121 ret = -EINVAL;
122 break;
123 }
124
125out:
126 tee_close_session(chimp_data.tee, chimp_data.session);
127 chimp_data.tee = NULL;
128
129 return ret;
130}
131
132int chimp_fastboot_optee(void)
133{
134 struct tee_invoke_arg arg;
135 int ret;
136
137 ret = init_arg(&arg, TEE_CHIMP_FASTBOOT);
138 if (ret < 0)
139 return ret;
140
141 ret = tee_invoke_func(chimp_data.tee, &arg, 0, NULL);
142 if (ret < 0) {
143 printf("Chimp boot_fail\n");
144 goto out;
145 }
146
147 switch (arg.ret) {
148 case TEE_SUCCESS:
149 ret = 0;
150 break;
151 default:
152 ret = -EINVAL;
153 break;
154 }
155
156out:
157 tee_close_session(chimp_data.tee, chimp_data.session);
158 chimp_data.tee = NULL;
159
160 return ret;
161}
162#else
163int chimp_handshake_status_optee(u32 timeout, u32 *status)
164{
165 printf("ChiMP handshake status fail (OPTEE not enabled)\n");
166
167 return -EINVAL;
168}
169
170int chimp_health_status_optee(u32 *status)
171{
172 printf("ChiMP health status fail (OPTEE not enabled)\n");
173
174 return -EINVAL;
175}
176
177int chimp_fastboot_optee(void)
178{
179 printf("ChiMP secure boot fail (OPTEE not enabled)\n");
180
181 return -EINVAL;
182}
183#endif
184
