xref: /optee_os/ta/pkcs11/src/pkcs11_token.c (revision 55e6965cf2b465eef3467856d114f67d04bc3553)
1c84ccd0aSEtienne Carriere // SPDX-License-Identifier: BSD-2-Clause
2c84ccd0aSEtienne Carriere /*
3c84ccd0aSEtienne Carriere  * Copyright (c) 2017-2020, Linaro Limited
4c84ccd0aSEtienne Carriere  */
5c84ccd0aSEtienne Carriere 
6c84ccd0aSEtienne Carriere #include <assert.h>
7d38f9635SEtienne Carriere #include <confine_array_index.h>
8c84ccd0aSEtienne Carriere #include <pkcs11_ta.h>
9d628ebd9SEtienne Carriere #include <printk.h>
10c84ccd0aSEtienne Carriere #include <string.h>
11c84ccd0aSEtienne Carriere #include <string_ext.h>
12c84ccd0aSEtienne Carriere #include <sys/queue.h>
13c84ccd0aSEtienne Carriere #include <tee_api_types.h>
14c84ccd0aSEtienne Carriere #include <tee_internal_api_extensions.h>
15c84ccd0aSEtienne Carriere #include <util.h>
16c84ccd0aSEtienne Carriere 
17512cbf1dSJens Wiklander #include "attributes.h"
18c84ccd0aSEtienne Carriere #include "pkcs11_helpers.h"
19ee49d9f2SEtienne Carriere #include "pkcs11_token.h"
20*55e6965cSEtienne Carriere #include "processing.h"
2122ac6984SEtienne Carriere #include "serializer.h"
22c84ccd0aSEtienne Carriere 
23c84ccd0aSEtienne Carriere /* Provide 3 slots/tokens, ID is token index */
24c84ccd0aSEtienne Carriere #ifndef CFG_PKCS11_TA_TOKEN_COUNT
25c84ccd0aSEtienne Carriere #define TOKEN_COUNT		3
26c84ccd0aSEtienne Carriere #else
27c84ccd0aSEtienne Carriere #define TOKEN_COUNT		CFG_PKCS11_TA_TOKEN_COUNT
28c84ccd0aSEtienne Carriere #endif
29c84ccd0aSEtienne Carriere 
30e084583eSEtienne Carriere /*
31e084583eSEtienne Carriere  * Structure tracking client applications
32e084583eSEtienne Carriere  *
33e084583eSEtienne Carriere  * @link - chained list of registered client applications
34e084583eSEtienne Carriere  * @sessions - list of the PKCS11 sessions opened by the client application
35e084583eSEtienne Carriere  */
36e084583eSEtienne Carriere struct pkcs11_client {
37e084583eSEtienne Carriere 	TAILQ_ENTRY(pkcs11_client) link;
38e084583eSEtienne Carriere 	struct session_list session_list;
39e084583eSEtienne Carriere 	struct handle_db session_handle_db;
40e084583eSEtienne Carriere };
41e084583eSEtienne Carriere 
42c84ccd0aSEtienne Carriere /* Static allocation of tokens runtime instances (reset to 0 at load) */
43c84ccd0aSEtienne Carriere struct ck_token ck_token[TOKEN_COUNT];
44c84ccd0aSEtienne Carriere 
45e084583eSEtienne Carriere static struct client_list pkcs11_client_list =
46e084583eSEtienne Carriere 	TAILQ_HEAD_INITIALIZER(pkcs11_client_list);
47e084583eSEtienne Carriere 
486e4f8f17SEtienne Carriere static void close_ck_session(struct pkcs11_session *session);
496e4f8f17SEtienne Carriere 
50c84ccd0aSEtienne Carriere struct ck_token *get_token(unsigned int token_id)
51c84ccd0aSEtienne Carriere {
52d38f9635SEtienne Carriere 	if (token_id < TOKEN_COUNT)
53d38f9635SEtienne Carriere 		return &ck_token[confine_array_index(token_id, TOKEN_COUNT)];
54c84ccd0aSEtienne Carriere 
55d38f9635SEtienne Carriere 	return NULL;
56c84ccd0aSEtienne Carriere }
57c84ccd0aSEtienne Carriere 
58c84ccd0aSEtienne Carriere unsigned int get_token_id(struct ck_token *token)
59c84ccd0aSEtienne Carriere {
60c84ccd0aSEtienne Carriere 	ptrdiff_t id = token - ck_token;
61c84ccd0aSEtienne Carriere 
62c84ccd0aSEtienne Carriere 	assert(id >= 0 && id < TOKEN_COUNT);
63c84ccd0aSEtienne Carriere 	return id;
64c84ccd0aSEtienne Carriere }
65c84ccd0aSEtienne Carriere 
66e084583eSEtienne Carriere struct pkcs11_client *tee_session2client(void *tee_session)
67e084583eSEtienne Carriere {
68e084583eSEtienne Carriere 	struct pkcs11_client *client = NULL;
69e084583eSEtienne Carriere 
70e084583eSEtienne Carriere 	TAILQ_FOREACH(client, &pkcs11_client_list, link)
71e084583eSEtienne Carriere 		if (client == tee_session)
72e084583eSEtienne Carriere 			break;
73e084583eSEtienne Carriere 
74e084583eSEtienne Carriere 	return client;
75e084583eSEtienne Carriere }
76e084583eSEtienne Carriere 
776e4f8f17SEtienne Carriere struct pkcs11_session *pkcs11_handle2session(uint32_t handle,
786e4f8f17SEtienne Carriere 					     struct pkcs11_client *client)
796e4f8f17SEtienne Carriere {
806e4f8f17SEtienne Carriere 	return handle_lookup(&client->session_handle_db, handle);
816e4f8f17SEtienne Carriere }
826e4f8f17SEtienne Carriere 
83e084583eSEtienne Carriere struct pkcs11_client *register_client(void)
84e084583eSEtienne Carriere {
85e084583eSEtienne Carriere 	struct pkcs11_client *client = NULL;
86e084583eSEtienne Carriere 
87e084583eSEtienne Carriere 	client = TEE_Malloc(sizeof(*client), TEE_MALLOC_FILL_ZERO);
88e084583eSEtienne Carriere 	if (!client)
89e084583eSEtienne Carriere 		return NULL;
90e084583eSEtienne Carriere 
91e084583eSEtienne Carriere 	TAILQ_INSERT_HEAD(&pkcs11_client_list, client, link);
92e084583eSEtienne Carriere 	TAILQ_INIT(&client->session_list);
93e084583eSEtienne Carriere 	handle_db_init(&client->session_handle_db);
94e084583eSEtienne Carriere 
95e084583eSEtienne Carriere 	return client;
96e084583eSEtienne Carriere }
97e084583eSEtienne Carriere 
98e084583eSEtienne Carriere void unregister_client(struct pkcs11_client *client)
99e084583eSEtienne Carriere {
1006e4f8f17SEtienne Carriere 	struct pkcs11_session *session = NULL;
1016e4f8f17SEtienne Carriere 	struct pkcs11_session *next = NULL;
1026e4f8f17SEtienne Carriere 
103e084583eSEtienne Carriere 	if (!client) {
104e084583eSEtienne Carriere 		EMSG("Invalid TEE session handle");
105e084583eSEtienne Carriere 		return;
106e084583eSEtienne Carriere 	}
107e084583eSEtienne Carriere 
1086e4f8f17SEtienne Carriere 	TAILQ_FOREACH_SAFE(session, &client->session_list, link, next)
1096e4f8f17SEtienne Carriere 		close_ck_session(session);
1106e4f8f17SEtienne Carriere 
111e084583eSEtienne Carriere 	TAILQ_REMOVE(&pkcs11_client_list, client, link);
112e084583eSEtienne Carriere 	handle_db_destroy(&client->session_handle_db);
113e084583eSEtienne Carriere 	TEE_Free(client);
114e084583eSEtienne Carriere }
115e084583eSEtienne Carriere 
116c84ccd0aSEtienne Carriere static TEE_Result pkcs11_token_init(unsigned int id)
117c84ccd0aSEtienne Carriere {
118c84ccd0aSEtienne Carriere 	struct ck_token *token = init_persistent_db(id);
119c84ccd0aSEtienne Carriere 
120c84ccd0aSEtienne Carriere 	if (!token)
121c84ccd0aSEtienne Carriere 		return TEE_ERROR_SECURITY;
122c84ccd0aSEtienne Carriere 
123c84ccd0aSEtienne Carriere 	if (token->state == PKCS11_TOKEN_RESET) {
124c84ccd0aSEtienne Carriere 		/* As per PKCS#11 spec, token resets to read/write state */
125c84ccd0aSEtienne Carriere 		token->state = PKCS11_TOKEN_READ_WRITE;
126c84ccd0aSEtienne Carriere 		token->session_count = 0;
127c84ccd0aSEtienne Carriere 		token->rw_session_count = 0;
128c84ccd0aSEtienne Carriere 	}
129c84ccd0aSEtienne Carriere 
130c84ccd0aSEtienne Carriere 	return TEE_SUCCESS;
131c84ccd0aSEtienne Carriere }
132c84ccd0aSEtienne Carriere 
133c84ccd0aSEtienne Carriere TEE_Result pkcs11_init(void)
134c84ccd0aSEtienne Carriere {
135c84ccd0aSEtienne Carriere 	unsigned int id = 0;
136c84ccd0aSEtienne Carriere 	TEE_Result ret = TEE_ERROR_GENERIC;
137c84ccd0aSEtienne Carriere 
138c84ccd0aSEtienne Carriere 	for (id = 0; id < TOKEN_COUNT; id++) {
139c84ccd0aSEtienne Carriere 		ret = pkcs11_token_init(id);
140c84ccd0aSEtienne Carriere 		if (ret)
141e084583eSEtienne Carriere 			break;
142c84ccd0aSEtienne Carriere 	}
143c84ccd0aSEtienne Carriere 
144c84ccd0aSEtienne Carriere 	return ret;
145c84ccd0aSEtienne Carriere }
146c84ccd0aSEtienne Carriere 
147c84ccd0aSEtienne Carriere void pkcs11_deinit(void)
148c84ccd0aSEtienne Carriere {
149c84ccd0aSEtienne Carriere 	unsigned int id = 0;
150c84ccd0aSEtienne Carriere 
151c84ccd0aSEtienne Carriere 	for (id = 0; id < TOKEN_COUNT; id++)
152c84ccd0aSEtienne Carriere 		close_persistent_db(get_token(id));
153c84ccd0aSEtienne Carriere }
15422ac6984SEtienne Carriere 
155512cbf1dSJens Wiklander /*
156512cbf1dSJens Wiklander  * Currently no support for dual operations.
157512cbf1dSJens Wiklander  */
158512cbf1dSJens Wiklander enum pkcs11_rc set_processing_state(struct pkcs11_session *session,
159512cbf1dSJens Wiklander 				    enum processing_func function,
160512cbf1dSJens Wiklander 				    struct pkcs11_object *obj1,
161512cbf1dSJens Wiklander 				    struct pkcs11_object *obj2)
162512cbf1dSJens Wiklander {
163512cbf1dSJens Wiklander 	enum pkcs11_proc_state state = PKCS11_SESSION_READY;
164512cbf1dSJens Wiklander 	struct active_processing *proc = NULL;
165512cbf1dSJens Wiklander 
166512cbf1dSJens Wiklander 	if (session->processing)
167512cbf1dSJens Wiklander 		return PKCS11_CKR_OPERATION_ACTIVE;
168512cbf1dSJens Wiklander 
169512cbf1dSJens Wiklander 	switch (function) {
170512cbf1dSJens Wiklander 	case PKCS11_FUNCTION_ENCRYPT:
171512cbf1dSJens Wiklander 		state = PKCS11_SESSION_ENCRYPTING;
172512cbf1dSJens Wiklander 		break;
173512cbf1dSJens Wiklander 	case PKCS11_FUNCTION_DECRYPT:
174512cbf1dSJens Wiklander 		state = PKCS11_SESSION_DECRYPTING;
175512cbf1dSJens Wiklander 		break;
176512cbf1dSJens Wiklander 	case PKCS11_FUNCTION_SIGN:
177512cbf1dSJens Wiklander 		state = PKCS11_SESSION_SIGNING;
178512cbf1dSJens Wiklander 		break;
179512cbf1dSJens Wiklander 	case PKCS11_FUNCTION_VERIFY:
180512cbf1dSJens Wiklander 		state = PKCS11_SESSION_VERIFYING;
181512cbf1dSJens Wiklander 		break;
182512cbf1dSJens Wiklander 	case PKCS11_FUNCTION_DIGEST:
183512cbf1dSJens Wiklander 		state = PKCS11_SESSION_DIGESTING;
184512cbf1dSJens Wiklander 		break;
185512cbf1dSJens Wiklander 	case PKCS11_FUNCTION_DERIVE:
186512cbf1dSJens Wiklander 		state = PKCS11_SESSION_READY;
187512cbf1dSJens Wiklander 		break;
188512cbf1dSJens Wiklander 	default:
189512cbf1dSJens Wiklander 		TEE_Panic(function);
190512cbf1dSJens Wiklander 		return -1;
191512cbf1dSJens Wiklander 	}
192512cbf1dSJens Wiklander 
193512cbf1dSJens Wiklander 	proc = TEE_Malloc(sizeof(*proc), TEE_MALLOC_FILL_ZERO);
194512cbf1dSJens Wiklander 	if (!proc)
195512cbf1dSJens Wiklander 		return PKCS11_CKR_DEVICE_MEMORY;
196512cbf1dSJens Wiklander 
197512cbf1dSJens Wiklander 	/* Boolean are default to false and pointers to NULL */
198512cbf1dSJens Wiklander 	proc->state = state;
199512cbf1dSJens Wiklander 	proc->tee_op_handle = TEE_HANDLE_NULL;
200512cbf1dSJens Wiklander 
201512cbf1dSJens Wiklander 	if (obj1 && get_bool(obj1->attributes, PKCS11_CKA_ALWAYS_AUTHENTICATE))
202512cbf1dSJens Wiklander 		proc->always_authen = true;
203512cbf1dSJens Wiklander 
204512cbf1dSJens Wiklander 	if (obj2 && get_bool(obj2->attributes, PKCS11_CKA_ALWAYS_AUTHENTICATE))
205512cbf1dSJens Wiklander 		proc->always_authen = true;
206512cbf1dSJens Wiklander 
207512cbf1dSJens Wiklander 	session->processing = proc;
208512cbf1dSJens Wiklander 
209512cbf1dSJens Wiklander 	return PKCS11_CKR_OK;
210512cbf1dSJens Wiklander }
211512cbf1dSJens Wiklander 
2124daf39b3SJens Wiklander enum pkcs11_rc entry_ck_slot_list(uint32_t ptypes, TEE_Param *params)
21322ac6984SEtienne Carriere {
21422ac6984SEtienne Carriere 	const uint32_t exp_pt = TEE_PARAM_TYPES(TEE_PARAM_TYPE_MEMREF_INOUT,
21522ac6984SEtienne Carriere 						TEE_PARAM_TYPE_NONE,
21622ac6984SEtienne Carriere 						TEE_PARAM_TYPE_MEMREF_OUTPUT,
21722ac6984SEtienne Carriere 						TEE_PARAM_TYPE_NONE);
21839b43b78SJens Wiklander 	TEE_Param *out = params + 2;
21922ac6984SEtienne Carriere 	uint32_t token_id = 0;
22022ac6984SEtienne Carriere 	const size_t out_size = sizeof(token_id) * TOKEN_COUNT;
22122ac6984SEtienne Carriere 	uint8_t *id = NULL;
22222ac6984SEtienne Carriere 
22322ac6984SEtienne Carriere 	if (ptypes != exp_pt ||
22422ac6984SEtienne Carriere 	    params[0].memref.size != TEE_PARAM0_SIZE_MIN)
22522ac6984SEtienne Carriere 		return PKCS11_CKR_ARGUMENTS_BAD;
22622ac6984SEtienne Carriere 
22722ac6984SEtienne Carriere 	if (out->memref.size < out_size) {
22822ac6984SEtienne Carriere 		out->memref.size = out_size;
22922ac6984SEtienne Carriere 
23022ac6984SEtienne Carriere 		if (out->memref.buffer)
23122ac6984SEtienne Carriere 			return PKCS11_CKR_BUFFER_TOO_SMALL;
23222ac6984SEtienne Carriere 		else
23322ac6984SEtienne Carriere 			return PKCS11_CKR_OK;
23422ac6984SEtienne Carriere 	}
23522ac6984SEtienne Carriere 
23622ac6984SEtienne Carriere 	for (token_id = 0, id = out->memref.buffer; token_id < TOKEN_COUNT;
23722ac6984SEtienne Carriere 	     token_id++, id += sizeof(token_id))
23822ac6984SEtienne Carriere 		TEE_MemMove(id, &token_id, sizeof(token_id));
23922ac6984SEtienne Carriere 
24022ac6984SEtienne Carriere 	out->memref.size = out_size;
24122ac6984SEtienne Carriere 
24222ac6984SEtienne Carriere 	return PKCS11_CKR_OK;
24322ac6984SEtienne Carriere }
244ce94efefSEtienne Carriere 
245b3ac5035SEtienne Carriere static void pad_str(uint8_t *str, size_t size)
246b3ac5035SEtienne Carriere {
247b3ac5035SEtienne Carriere 	int n = strnlen((char *)str, size);
248b3ac5035SEtienne Carriere 
249b3ac5035SEtienne Carriere 	TEE_MemFill(str + n, ' ', size - n);
250b3ac5035SEtienne Carriere }
251b3ac5035SEtienne Carriere 
252d628ebd9SEtienne Carriere static void set_token_description(struct pkcs11_slot_info *info)
253d628ebd9SEtienne Carriere {
254d628ebd9SEtienne Carriere 	char desc[sizeof(info->slot_description) + 1] = { 0 };
255d628ebd9SEtienne Carriere 	TEE_UUID dev_id = { };
256d628ebd9SEtienne Carriere 	TEE_Result res = TEE_ERROR_GENERIC;
257d628ebd9SEtienne Carriere 	int n = 0;
258d628ebd9SEtienne Carriere 
259d628ebd9SEtienne Carriere 	res = TEE_GetPropertyAsUUID(TEE_PROPSET_TEE_IMPLEMENTATION,
260d628ebd9SEtienne Carriere 				    "gpd.tee.deviceID", &dev_id);
261d628ebd9SEtienne Carriere 	if (res == TEE_SUCCESS) {
262d628ebd9SEtienne Carriere 		n = snprintk(desc, sizeof(desc), PKCS11_SLOT_DESCRIPTION
263d628ebd9SEtienne Carriere 			     " - TEE UUID %pUl", (void *)&dev_id);
264d628ebd9SEtienne Carriere 	} else {
265d628ebd9SEtienne Carriere 		n = snprintf(desc, sizeof(desc), PKCS11_SLOT_DESCRIPTION
266d628ebd9SEtienne Carriere 			     " - No TEE UUID");
267d628ebd9SEtienne Carriere 	}
268d628ebd9SEtienne Carriere 	if (n < 0 || n >= (int)sizeof(desc))
269d628ebd9SEtienne Carriere 		TEE_Panic(0);
270d628ebd9SEtienne Carriere 
271d628ebd9SEtienne Carriere 	TEE_MemMove(info->slot_description, desc, n);
272d628ebd9SEtienne Carriere 	pad_str(info->slot_description, sizeof(info->slot_description));
273d628ebd9SEtienne Carriere }
274d628ebd9SEtienne Carriere 
2754daf39b3SJens Wiklander enum pkcs11_rc entry_ck_slot_info(uint32_t ptypes, TEE_Param *params)
276ce94efefSEtienne Carriere {
277ce94efefSEtienne Carriere 	const uint32_t exp_pt = TEE_PARAM_TYPES(TEE_PARAM_TYPE_MEMREF_INOUT,
278ce94efefSEtienne Carriere 						TEE_PARAM_TYPE_NONE,
279ce94efefSEtienne Carriere 						TEE_PARAM_TYPE_MEMREF_OUTPUT,
280ce94efefSEtienne Carriere 						TEE_PARAM_TYPE_NONE);
28139b43b78SJens Wiklander 	TEE_Param *ctrl = params;
28239b43b78SJens Wiklander 	TEE_Param *out = params + 2;
2834daf39b3SJens Wiklander 	enum pkcs11_rc rc = PKCS11_CKR_OK;
284ce94efefSEtienne Carriere 	struct serialargs ctrlargs = { };
285ce94efefSEtienne Carriere 	uint32_t token_id = 0;
286ce94efefSEtienne Carriere 	struct pkcs11_slot_info info = {
287ce94efefSEtienne Carriere 		.slot_description = PKCS11_SLOT_DESCRIPTION,
288ce94efefSEtienne Carriere 		.manufacturer_id = PKCS11_SLOT_MANUFACTURER,
289ce94efefSEtienne Carriere 		.flags = PKCS11_CKFS_TOKEN_PRESENT,
290ce94efefSEtienne Carriere 		.hardware_version = PKCS11_SLOT_HW_VERSION,
291ce94efefSEtienne Carriere 		.firmware_version = PKCS11_SLOT_FW_VERSION,
292ce94efefSEtienne Carriere 	};
293ce94efefSEtienne Carriere 
294ce94efefSEtienne Carriere 	COMPILE_TIME_ASSERT(sizeof(PKCS11_SLOT_DESCRIPTION) <=
295ce94efefSEtienne Carriere 			    sizeof(info.slot_description));
296ce94efefSEtienne Carriere 	COMPILE_TIME_ASSERT(sizeof(PKCS11_SLOT_MANUFACTURER) <=
297ce94efefSEtienne Carriere 			    sizeof(info.manufacturer_id));
298ce94efefSEtienne Carriere 
299ce94efefSEtienne Carriere 	if (ptypes != exp_pt || out->memref.size != sizeof(info))
300ce94efefSEtienne Carriere 		return PKCS11_CKR_ARGUMENTS_BAD;
301ce94efefSEtienne Carriere 
302ce94efefSEtienne Carriere 	serialargs_init(&ctrlargs, ctrl->memref.buffer, ctrl->memref.size);
303ce94efefSEtienne Carriere 
3044daf39b3SJens Wiklander 	rc = serialargs_get(&ctrlargs, &token_id, sizeof(token_id));
3054daf39b3SJens Wiklander 	if (rc)
3064daf39b3SJens Wiklander 		return rc;
307ce94efefSEtienne Carriere 
308ce94efefSEtienne Carriere 	if (serialargs_remaining_bytes(&ctrlargs))
309ce94efefSEtienne Carriere 		return PKCS11_CKR_ARGUMENTS_BAD;
310ce94efefSEtienne Carriere 
31129b0949aSEtienne Carriere 	if (!get_token(token_id))
312ce94efefSEtienne Carriere 		return PKCS11_CKR_SLOT_ID_INVALID;
313ce94efefSEtienne Carriere 
314d628ebd9SEtienne Carriere 	set_token_description(&info);
315d628ebd9SEtienne Carriere 
316b3ac5035SEtienne Carriere 	pad_str(info.manufacturer_id, sizeof(info.manufacturer_id));
317ce94efefSEtienne Carriere 
318ce94efefSEtienne Carriere 	out->memref.size = sizeof(info);
319ce94efefSEtienne Carriere 	TEE_MemMove(out->memref.buffer, &info, out->memref.size);
320ce94efefSEtienne Carriere 
321ce94efefSEtienne Carriere 	return PKCS11_CKR_OK;
322ce94efefSEtienne Carriere }
323030e7392SEtienne Carriere 
3244daf39b3SJens Wiklander enum pkcs11_rc entry_ck_token_info(uint32_t ptypes, TEE_Param *params)
325030e7392SEtienne Carriere {
326030e7392SEtienne Carriere 	const uint32_t exp_pt = TEE_PARAM_TYPES(TEE_PARAM_TYPE_MEMREF_INOUT,
327030e7392SEtienne Carriere 						TEE_PARAM_TYPE_NONE,
328030e7392SEtienne Carriere 						TEE_PARAM_TYPE_MEMREF_OUTPUT,
329030e7392SEtienne Carriere 						TEE_PARAM_TYPE_NONE);
33039b43b78SJens Wiklander 	TEE_Param *ctrl = params;
33139b43b78SJens Wiklander 	TEE_Param *out = params + 2;
3324daf39b3SJens Wiklander 	enum pkcs11_rc rc = PKCS11_CKR_OK;
333030e7392SEtienne Carriere 	struct serialargs ctrlargs = { };
334030e7392SEtienne Carriere 	uint32_t token_id = 0;
335030e7392SEtienne Carriere 	struct ck_token *token = NULL;
336030e7392SEtienne Carriere 	struct pkcs11_token_info info = {
337030e7392SEtienne Carriere 		.manufacturer_id = PKCS11_TOKEN_MANUFACTURER,
338030e7392SEtienne Carriere 		.model = PKCS11_TOKEN_MODEL,
339030e7392SEtienne Carriere 		.max_session_count = UINT32_MAX,
340030e7392SEtienne Carriere 		.max_rw_session_count = UINT32_MAX,
341030e7392SEtienne Carriere 		.max_pin_len = PKCS11_TOKEN_PIN_SIZE_MAX,
342030e7392SEtienne Carriere 		.min_pin_len = PKCS11_TOKEN_PIN_SIZE_MIN,
343030e7392SEtienne Carriere 		.total_public_memory = UINT32_MAX,
344030e7392SEtienne Carriere 		.free_public_memory = UINT32_MAX,
345030e7392SEtienne Carriere 		.total_private_memory = UINT32_MAX,
346030e7392SEtienne Carriere 		.free_private_memory = UINT32_MAX,
347030e7392SEtienne Carriere 		.hardware_version = PKCS11_TOKEN_HW_VERSION,
348030e7392SEtienne Carriere 		.firmware_version = PKCS11_TOKEN_FW_VERSION,
349030e7392SEtienne Carriere 	};
35002b4d42aSEtienne Carriere 	char sn[sizeof(info.serial_number) + 1] = { 0 };
35102b4d42aSEtienne Carriere 	int n = 0;
352030e7392SEtienne Carriere 
353030e7392SEtienne Carriere 	if (ptypes != exp_pt || out->memref.size != sizeof(info))
354030e7392SEtienne Carriere 		return PKCS11_CKR_ARGUMENTS_BAD;
355030e7392SEtienne Carriere 
356030e7392SEtienne Carriere 	serialargs_init(&ctrlargs, ctrl->memref.buffer, ctrl->memref.size);
357030e7392SEtienne Carriere 
3584daf39b3SJens Wiklander 	rc = serialargs_get(&ctrlargs, &token_id, sizeof(token_id));
3594daf39b3SJens Wiklander 	if (rc)
3604daf39b3SJens Wiklander 		return rc;
361030e7392SEtienne Carriere 
362030e7392SEtienne Carriere 	if (serialargs_remaining_bytes(&ctrlargs))
363030e7392SEtienne Carriere 		return PKCS11_CKR_ARGUMENTS_BAD;
364030e7392SEtienne Carriere 
365030e7392SEtienne Carriere 	token = get_token(token_id);
366030e7392SEtienne Carriere 	if (!token)
367030e7392SEtienne Carriere 		return PKCS11_CKR_SLOT_ID_INVALID;
368030e7392SEtienne Carriere 
369030e7392SEtienne Carriere 	pad_str(info.manufacturer_id, sizeof(info.manufacturer_id));
370030e7392SEtienne Carriere 	pad_str(info.model, sizeof(info.model));
37102b4d42aSEtienne Carriere 
37202b4d42aSEtienne Carriere 	n = snprintf(sn, sizeof(sn), "%0*"PRIu32,
37302b4d42aSEtienne Carriere 		     (int)sizeof(info.serial_number), token_id);
37402b4d42aSEtienne Carriere 	if (n != (int)sizeof(info.serial_number))
37502b4d42aSEtienne Carriere 		TEE_Panic(0);
37602b4d42aSEtienne Carriere 
37702b4d42aSEtienne Carriere 	TEE_MemMove(info.serial_number, sn, sizeof(info.serial_number));
378030e7392SEtienne Carriere 	pad_str(info.serial_number, sizeof(info.serial_number));
379030e7392SEtienne Carriere 
380030e7392SEtienne Carriere 	TEE_MemMove(info.label, token->db_main->label, sizeof(info.label));
381030e7392SEtienne Carriere 
382030e7392SEtienne Carriere 	info.flags = token->db_main->flags;
383030e7392SEtienne Carriere 	info.session_count = token->session_count;
384030e7392SEtienne Carriere 	info.rw_session_count = token->rw_session_count;
385030e7392SEtienne Carriere 
386030e7392SEtienne Carriere 	TEE_MemMove(out->memref.buffer, &info, sizeof(info));
387030e7392SEtienne Carriere 
388030e7392SEtienne Carriere 	return PKCS11_CKR_OK;
389030e7392SEtienne Carriere }
3906f74919dSEtienne Carriere 
3916f74919dSEtienne Carriere static void dmsg_print_supported_mechanism(unsigned int token_id __maybe_unused,
3926f74919dSEtienne Carriere 					   uint32_t *array __maybe_unused,
3936f74919dSEtienne Carriere 					   size_t count __maybe_unused)
3946f74919dSEtienne Carriere {
3956f74919dSEtienne Carriere 	size_t __maybe_unused n = 0;
3966f74919dSEtienne Carriere 
3976f74919dSEtienne Carriere 	if (TRACE_LEVEL < TRACE_DEBUG)
3986f74919dSEtienne Carriere 		return;
3996f74919dSEtienne Carriere 
4006f74919dSEtienne Carriere 	for (n = 0; n < count; n++)
4016f74919dSEtienne Carriere 		DMSG("PKCS11 token %"PRIu32": mechanism 0x%04"PRIx32": %s",
4026f74919dSEtienne Carriere 		     token_id, array[n], id2str_mechanism(array[n]));
4036f74919dSEtienne Carriere }
4046f74919dSEtienne Carriere 
4054daf39b3SJens Wiklander enum pkcs11_rc entry_ck_token_mecha_ids(uint32_t ptypes, TEE_Param *params)
4066f74919dSEtienne Carriere {
4076f74919dSEtienne Carriere 	const uint32_t exp_pt = TEE_PARAM_TYPES(TEE_PARAM_TYPE_MEMREF_INOUT,
4086f74919dSEtienne Carriere 						TEE_PARAM_TYPE_NONE,
4096f74919dSEtienne Carriere 						TEE_PARAM_TYPE_MEMREF_OUTPUT,
4106f74919dSEtienne Carriere 						TEE_PARAM_TYPE_NONE);
41139b43b78SJens Wiklander 	TEE_Param *ctrl = params;
41239b43b78SJens Wiklander 	TEE_Param *out = params + 2;
4134daf39b3SJens Wiklander 	enum pkcs11_rc rc = PKCS11_CKR_OK;
4146f74919dSEtienne Carriere 	struct serialargs ctrlargs = { };
4156f74919dSEtienne Carriere 	uint32_t token_id = 0;
4166f74919dSEtienne Carriere 	struct ck_token __maybe_unused *token = NULL;
4176f74919dSEtienne Carriere 	size_t count = 0;
4186f74919dSEtienne Carriere 	uint32_t *array = NULL;
4196f74919dSEtienne Carriere 
4206f74919dSEtienne Carriere 	if (ptypes != exp_pt)
4216f74919dSEtienne Carriere 		return PKCS11_CKR_ARGUMENTS_BAD;
4226f74919dSEtienne Carriere 
4236f74919dSEtienne Carriere 	serialargs_init(&ctrlargs, ctrl->memref.buffer, ctrl->memref.size);
4246f74919dSEtienne Carriere 
4254daf39b3SJens Wiklander 	rc = serialargs_get(&ctrlargs, &token_id, sizeof(token_id));
4264daf39b3SJens Wiklander 	if (rc)
4274daf39b3SJens Wiklander 		return rc;
4286f74919dSEtienne Carriere 
4296f74919dSEtienne Carriere 	if (serialargs_remaining_bytes(&ctrlargs))
4306f74919dSEtienne Carriere 		return PKCS11_CKR_ARGUMENTS_BAD;
4316f74919dSEtienne Carriere 
4326f74919dSEtienne Carriere 	token = get_token(token_id);
4336f74919dSEtienne Carriere 	if (!token)
4346f74919dSEtienne Carriere 		return PKCS11_CKR_SLOT_ID_INVALID;
4356f74919dSEtienne Carriere 
4366f74919dSEtienne Carriere 	count = out->memref.size / sizeof(*array);
4376f74919dSEtienne Carriere 	array = tee_malloc_mechanism_list(&count);
4386f74919dSEtienne Carriere 
4396f74919dSEtienne Carriere 	if (out->memref.size < count * sizeof(*array)) {
4406f74919dSEtienne Carriere 		assert(!array);
4416f74919dSEtienne Carriere 		out->memref.size = count * sizeof(*array);
4426459f267SEtienne Carriere 		if (out->memref.buffer)
4436f74919dSEtienne Carriere 			return PKCS11_CKR_BUFFER_TOO_SMALL;
4446459f267SEtienne Carriere 		else
4456459f267SEtienne Carriere 			return PKCS11_CKR_OK;
4466f74919dSEtienne Carriere 	}
4476f74919dSEtienne Carriere 
4486f74919dSEtienne Carriere 	if (!array)
4496f74919dSEtienne Carriere 		return PKCS11_CKR_DEVICE_MEMORY;
4506f74919dSEtienne Carriere 
4516f74919dSEtienne Carriere 	dmsg_print_supported_mechanism(token_id, array, count);
4526f74919dSEtienne Carriere 
4536f74919dSEtienne Carriere 	out->memref.size = count * sizeof(*array);
4546f74919dSEtienne Carriere 	TEE_MemMove(out->memref.buffer, array, out->memref.size);
4556f74919dSEtienne Carriere 
4566f74919dSEtienne Carriere 	TEE_Free(array);
4576f74919dSEtienne Carriere 
4584daf39b3SJens Wiklander 	return rc;
4596f74919dSEtienne Carriere }
4601d3ebedbSEtienne Carriere 
4614daf39b3SJens Wiklander enum pkcs11_rc entry_ck_token_mecha_info(uint32_t ptypes, TEE_Param *params)
4621d3ebedbSEtienne Carriere {
4631d3ebedbSEtienne Carriere 	const uint32_t exp_pt = TEE_PARAM_TYPES(TEE_PARAM_TYPE_MEMREF_INOUT,
4641d3ebedbSEtienne Carriere 						TEE_PARAM_TYPE_NONE,
4651d3ebedbSEtienne Carriere 						TEE_PARAM_TYPE_MEMREF_OUTPUT,
4661d3ebedbSEtienne Carriere 						TEE_PARAM_TYPE_NONE);
46739b43b78SJens Wiklander 	TEE_Param *ctrl = params;
46839b43b78SJens Wiklander 	TEE_Param *out = params + 2;
4694daf39b3SJens Wiklander 	enum pkcs11_rc rc = PKCS11_CKR_OK;
4701d3ebedbSEtienne Carriere 	struct serialargs ctrlargs = { };
4711d3ebedbSEtienne Carriere 	uint32_t token_id = 0;
4721d3ebedbSEtienne Carriere 	uint32_t type = 0;
4731d3ebedbSEtienne Carriere 	struct ck_token *token = NULL;
4741d3ebedbSEtienne Carriere 	struct pkcs11_mechanism_info info = { };
4751d3ebedbSEtienne Carriere 
4761d3ebedbSEtienne Carriere 	if (ptypes != exp_pt || out->memref.size != sizeof(info))
4771d3ebedbSEtienne Carriere 		return PKCS11_CKR_ARGUMENTS_BAD;
4781d3ebedbSEtienne Carriere 
4791d3ebedbSEtienne Carriere 	serialargs_init(&ctrlargs, ctrl->memref.buffer, ctrl->memref.size);
4801d3ebedbSEtienne Carriere 
4814daf39b3SJens Wiklander 	rc = serialargs_get(&ctrlargs, &token_id, sizeof(uint32_t));
4824daf39b3SJens Wiklander 	if (rc)
4834daf39b3SJens Wiklander 		return rc;
4841d3ebedbSEtienne Carriere 
4854daf39b3SJens Wiklander 	rc = serialargs_get(&ctrlargs, &type, sizeof(uint32_t));
4864daf39b3SJens Wiklander 	if (rc)
4874daf39b3SJens Wiklander 		return rc;
4881d3ebedbSEtienne Carriere 
4891d3ebedbSEtienne Carriere 	if (serialargs_remaining_bytes(&ctrlargs))
4901d3ebedbSEtienne Carriere 		return PKCS11_CKR_ARGUMENTS_BAD;
4911d3ebedbSEtienne Carriere 
4921d3ebedbSEtienne Carriere 	token = get_token(token_id);
4931d3ebedbSEtienne Carriere 	if (!token)
4941d3ebedbSEtienne Carriere 		return PKCS11_CKR_SLOT_ID_INVALID;
4951d3ebedbSEtienne Carriere 
4961d3ebedbSEtienne Carriere 	if (!mechanism_is_valid(type))
4971d3ebedbSEtienne Carriere 		return PKCS11_CKR_MECHANISM_INVALID;
4981d3ebedbSEtienne Carriere 
4991d3ebedbSEtienne Carriere 	info.flags = mechanism_supported_flags(type);
5001d3ebedbSEtienne Carriere 
50178adf52fSEtienne Carriere 	mechanism_supported_key_sizes(type, &info.min_key_size,
5021d3ebedbSEtienne Carriere 				      &info.max_key_size);
5031d3ebedbSEtienne Carriere 
5041d3ebedbSEtienne Carriere 	TEE_MemMove(out->memref.buffer, &info, sizeof(info));
5051d3ebedbSEtienne Carriere 
5061d3ebedbSEtienne Carriere 	DMSG("PKCS11 token %"PRIu32": mechanism 0x%"PRIx32" info",
5071d3ebedbSEtienne Carriere 	     token_id, type);
5081d3ebedbSEtienne Carriere 
5091d3ebedbSEtienne Carriere 	return PKCS11_CKR_OK;
5101d3ebedbSEtienne Carriere }
5116e4f8f17SEtienne Carriere 
5126e4f8f17SEtienne Carriere /* Select the ReadOnly or ReadWrite state for session login state */
5136e4f8f17SEtienne Carriere static void set_session_state(struct pkcs11_client *client,
5146e4f8f17SEtienne Carriere 			      struct pkcs11_session *session, bool readonly)
5156e4f8f17SEtienne Carriere {
5166e4f8f17SEtienne Carriere 	struct pkcs11_session *sess = NULL;
5176e4f8f17SEtienne Carriere 	enum pkcs11_session_state state = PKCS11_CKS_RO_PUBLIC_SESSION;
5186e4f8f17SEtienne Carriere 
5196e4f8f17SEtienne Carriere 	/* Default to public session if no session already registered */
5206e4f8f17SEtienne Carriere 	if (readonly)
5216e4f8f17SEtienne Carriere 		state = PKCS11_CKS_RO_PUBLIC_SESSION;
5226e4f8f17SEtienne Carriere 	else
5236e4f8f17SEtienne Carriere 		state = PKCS11_CKS_RW_PUBLIC_SESSION;
5246e4f8f17SEtienne Carriere 
5256e4f8f17SEtienne Carriere 	/*
5266e4f8f17SEtienne Carriere 	 * No need to check all client sessions, the first found in
5276e4f8f17SEtienne Carriere 	 * target token gives client login configuration.
5286e4f8f17SEtienne Carriere 	 */
5296e4f8f17SEtienne Carriere 	TAILQ_FOREACH(sess, &client->session_list, link) {
5306e4f8f17SEtienne Carriere 		assert(sess != session);
5316e4f8f17SEtienne Carriere 
5326e4f8f17SEtienne Carriere 		if (sess->token == session->token) {
5336e4f8f17SEtienne Carriere 			switch (sess->state) {
5346e4f8f17SEtienne Carriere 			case PKCS11_CKS_RW_PUBLIC_SESSION:
5356e4f8f17SEtienne Carriere 			case PKCS11_CKS_RO_PUBLIC_SESSION:
5366e4f8f17SEtienne Carriere 				if (readonly)
5376e4f8f17SEtienne Carriere 					state = PKCS11_CKS_RO_PUBLIC_SESSION;
5386e4f8f17SEtienne Carriere 				else
5396e4f8f17SEtienne Carriere 					state = PKCS11_CKS_RW_PUBLIC_SESSION;
5406e4f8f17SEtienne Carriere 				break;
5416e4f8f17SEtienne Carriere 			case PKCS11_CKS_RO_USER_FUNCTIONS:
5426e4f8f17SEtienne Carriere 			case PKCS11_CKS_RW_USER_FUNCTIONS:
5436e4f8f17SEtienne Carriere 				if (readonly)
5446e4f8f17SEtienne Carriere 					state = PKCS11_CKS_RO_USER_FUNCTIONS;
5456e4f8f17SEtienne Carriere 				else
5466e4f8f17SEtienne Carriere 					state = PKCS11_CKS_RW_USER_FUNCTIONS;
5476e4f8f17SEtienne Carriere 				break;
5486e4f8f17SEtienne Carriere 			case PKCS11_CKS_RW_SO_FUNCTIONS:
5496e4f8f17SEtienne Carriere 				if (readonly)
5506e4f8f17SEtienne Carriere 					TEE_Panic(0);
5516e4f8f17SEtienne Carriere 				else
5526e4f8f17SEtienne Carriere 					state = PKCS11_CKS_RW_SO_FUNCTIONS;
5536e4f8f17SEtienne Carriere 				break;
5546e4f8f17SEtienne Carriere 			default:
5556e4f8f17SEtienne Carriere 				TEE_Panic(0);
5566e4f8f17SEtienne Carriere 			}
5576e4f8f17SEtienne Carriere 			break;
5586e4f8f17SEtienne Carriere 		}
5596e4f8f17SEtienne Carriere 	}
5606e4f8f17SEtienne Carriere 
5616e4f8f17SEtienne Carriere 	session->state = state;
5626e4f8f17SEtienne Carriere }
5636e4f8f17SEtienne Carriere 
5644daf39b3SJens Wiklander enum pkcs11_rc entry_ck_open_session(struct pkcs11_client *client,
5656e4f8f17SEtienne Carriere 				     uint32_t ptypes, TEE_Param *params)
5666e4f8f17SEtienne Carriere {
5676e4f8f17SEtienne Carriere 	const uint32_t exp_pt = TEE_PARAM_TYPES(TEE_PARAM_TYPE_MEMREF_INOUT,
5686e4f8f17SEtienne Carriere 						TEE_PARAM_TYPE_NONE,
5696e4f8f17SEtienne Carriere 						TEE_PARAM_TYPE_MEMREF_OUTPUT,
5706e4f8f17SEtienne Carriere 						TEE_PARAM_TYPE_NONE);
57139b43b78SJens Wiklander 	TEE_Param *ctrl = params;
57239b43b78SJens Wiklander 	TEE_Param *out = params + 2;
5734daf39b3SJens Wiklander 	enum pkcs11_rc rc = PKCS11_CKR_OK;
5746e4f8f17SEtienne Carriere 	struct serialargs ctrlargs = { };
5756e4f8f17SEtienne Carriere 	uint32_t token_id = 0;
5766e4f8f17SEtienne Carriere 	uint32_t flags = 0;
5776e4f8f17SEtienne Carriere 	struct ck_token *token = NULL;
5786e4f8f17SEtienne Carriere 	struct pkcs11_session *session = NULL;
5796e4f8f17SEtienne Carriere 	bool readonly = false;
5806e4f8f17SEtienne Carriere 
5816e4f8f17SEtienne Carriere 	if (!client || ptypes != exp_pt ||
5826e4f8f17SEtienne Carriere 	    out->memref.size != sizeof(session->handle))
5836e4f8f17SEtienne Carriere 		return PKCS11_CKR_ARGUMENTS_BAD;
5846e4f8f17SEtienne Carriere 
5856e4f8f17SEtienne Carriere 	serialargs_init(&ctrlargs, ctrl->memref.buffer, ctrl->memref.size);
5866e4f8f17SEtienne Carriere 
5874daf39b3SJens Wiklander 	rc = serialargs_get(&ctrlargs, &token_id, sizeof(token_id));
5884daf39b3SJens Wiklander 	if (rc)
5894daf39b3SJens Wiklander 		return rc;
5906e4f8f17SEtienne Carriere 
5914daf39b3SJens Wiklander 	rc = serialargs_get(&ctrlargs, &flags, sizeof(flags));
5924daf39b3SJens Wiklander 	if (rc)
5934daf39b3SJens Wiklander 		return rc;
5946e4f8f17SEtienne Carriere 
5956e4f8f17SEtienne Carriere 	if (serialargs_remaining_bytes(&ctrlargs))
5966e4f8f17SEtienne Carriere 		return PKCS11_CKR_ARGUMENTS_BAD;
5976e4f8f17SEtienne Carriere 
5986e4f8f17SEtienne Carriere 	token = get_token(token_id);
5996e4f8f17SEtienne Carriere 	if (!token)
6006e4f8f17SEtienne Carriere 		return PKCS11_CKR_SLOT_ID_INVALID;
6016e4f8f17SEtienne Carriere 
6026e4f8f17SEtienne Carriere 	/* Sanitize session flags */
6036e4f8f17SEtienne Carriere 	if (!(flags & PKCS11_CKFSS_SERIAL_SESSION) ||
6046e4f8f17SEtienne Carriere 	    (flags & ~(PKCS11_CKFSS_RW_SESSION |
6056e4f8f17SEtienne Carriere 		       PKCS11_CKFSS_SERIAL_SESSION)))
6066e4f8f17SEtienne Carriere 		return PKCS11_CKR_ARGUMENTS_BAD;
6076e4f8f17SEtienne Carriere 
6086e4f8f17SEtienne Carriere 	readonly = !(flags & PKCS11_CKFSS_RW_SESSION);
6096e4f8f17SEtienne Carriere 
6106e4f8f17SEtienne Carriere 	if (!readonly && token->state == PKCS11_TOKEN_READ_ONLY)
6116e4f8f17SEtienne Carriere 		return PKCS11_CKR_TOKEN_WRITE_PROTECTED;
6126e4f8f17SEtienne Carriere 
6136e4f8f17SEtienne Carriere 	if (readonly) {
6146e4f8f17SEtienne Carriere 		/* Specifically reject read-only session under SO login */
6156e4f8f17SEtienne Carriere 		TAILQ_FOREACH(session, &client->session_list, link)
6166e4f8f17SEtienne Carriere 			if (pkcs11_session_is_so(session))
6176e4f8f17SEtienne Carriere 				return PKCS11_CKR_SESSION_READ_WRITE_SO_EXISTS;
6186e4f8f17SEtienne Carriere 	}
6196e4f8f17SEtienne Carriere 
6206e4f8f17SEtienne Carriere 	session = TEE_Malloc(sizeof(*session), TEE_MALLOC_FILL_ZERO);
6216e4f8f17SEtienne Carriere 	if (!session)
6226e4f8f17SEtienne Carriere 		return PKCS11_CKR_DEVICE_MEMORY;
6236e4f8f17SEtienne Carriere 
6246e4f8f17SEtienne Carriere 	session->handle = handle_get(&client->session_handle_db, session);
6256e4f8f17SEtienne Carriere 	if (!session->handle) {
6266e4f8f17SEtienne Carriere 		TEE_Free(session);
6276e4f8f17SEtienne Carriere 		return PKCS11_CKR_DEVICE_MEMORY;
6286e4f8f17SEtienne Carriere 	}
6296e4f8f17SEtienne Carriere 
6306e4f8f17SEtienne Carriere 	session->token = token;
6316e4f8f17SEtienne Carriere 	session->client = client;
6326e4f8f17SEtienne Carriere 
633b56b3d07SJens Wiklander 	LIST_INIT(&session->object_list);
634b56b3d07SJens Wiklander 	handle_db_init(&session->object_handle_db);
635b56b3d07SJens Wiklander 
6366e4f8f17SEtienne Carriere 	set_session_state(client, session, readonly);
6376e4f8f17SEtienne Carriere 
6386e4f8f17SEtienne Carriere 	TAILQ_INSERT_HEAD(&client->session_list, session, link);
6396e4f8f17SEtienne Carriere 
6406e4f8f17SEtienne Carriere 	session->token->session_count++;
6416e4f8f17SEtienne Carriere 	if (!readonly)
6426e4f8f17SEtienne Carriere 		session->token->rw_session_count++;
6436e4f8f17SEtienne Carriere 
6446e4f8f17SEtienne Carriere 	TEE_MemMove(out->memref.buffer, &session->handle,
6456e4f8f17SEtienne Carriere 		    sizeof(session->handle));
6466e4f8f17SEtienne Carriere 
6476e4f8f17SEtienne Carriere 	DMSG("Open PKCS11 session %"PRIu32, session->handle);
6486e4f8f17SEtienne Carriere 
6496e4f8f17SEtienne Carriere 	return PKCS11_CKR_OK;
6506e4f8f17SEtienne Carriere }
6516e4f8f17SEtienne Carriere 
6526e4f8f17SEtienne Carriere static void close_ck_session(struct pkcs11_session *session)
6536e4f8f17SEtienne Carriere {
654*55e6965cSEtienne Carriere 	release_active_processing(session);
655*55e6965cSEtienne Carriere 
656b56b3d07SJens Wiklander 	/* No need to put object handles, the whole database is destroyed */
657b56b3d07SJens Wiklander 	while (!LIST_EMPTY(&session->object_list))
658b56b3d07SJens Wiklander 		destroy_object(session,
659b56b3d07SJens Wiklander 			       LIST_FIRST(&session->object_list), true);
660b56b3d07SJens Wiklander 
6616e4f8f17SEtienne Carriere 	TAILQ_REMOVE(&session->client->session_list, session, link);
6626e4f8f17SEtienne Carriere 	handle_put(&session->client->session_handle_db, session->handle);
663b56b3d07SJens Wiklander 	handle_db_destroy(&session->object_handle_db);
6646e4f8f17SEtienne Carriere 
6656e4f8f17SEtienne Carriere 	session->token->session_count--;
6666e4f8f17SEtienne Carriere 	if (pkcs11_session_is_read_write(session))
6676e4f8f17SEtienne Carriere 		session->token->rw_session_count--;
6686e4f8f17SEtienne Carriere 
6696e4f8f17SEtienne Carriere 	TEE_Free(session);
6706e4f8f17SEtienne Carriere 
6716e4f8f17SEtienne Carriere 	DMSG("Close PKCS11 session %"PRIu32, session->handle);
6726e4f8f17SEtienne Carriere }
6736e4f8f17SEtienne Carriere 
6744daf39b3SJens Wiklander enum pkcs11_rc entry_ck_close_session(struct pkcs11_client *client,
6756e4f8f17SEtienne Carriere 				      uint32_t ptypes, TEE_Param *params)
6766e4f8f17SEtienne Carriere {
6776e4f8f17SEtienne Carriere 	const uint32_t exp_pt = TEE_PARAM_TYPES(TEE_PARAM_TYPE_MEMREF_INOUT,
6786e4f8f17SEtienne Carriere 						TEE_PARAM_TYPE_NONE,
6796e4f8f17SEtienne Carriere 						TEE_PARAM_TYPE_NONE,
6806e4f8f17SEtienne Carriere 						TEE_PARAM_TYPE_NONE);
68139b43b78SJens Wiklander 	TEE_Param *ctrl = params;
6824daf39b3SJens Wiklander 	enum pkcs11_rc rc = PKCS11_CKR_OK;
6836e4f8f17SEtienne Carriere 	struct serialargs ctrlargs = { };
6846e4f8f17SEtienne Carriere 	struct pkcs11_session *session = NULL;
6856e4f8f17SEtienne Carriere 
6866e4f8f17SEtienne Carriere 	if (!client || ptypes != exp_pt)
6876e4f8f17SEtienne Carriere 		return PKCS11_CKR_ARGUMENTS_BAD;
6886e4f8f17SEtienne Carriere 
6896e4f8f17SEtienne Carriere 	serialargs_init(&ctrlargs, ctrl->memref.buffer, ctrl->memref.size);
6906e4f8f17SEtienne Carriere 
6914daf39b3SJens Wiklander 	rc = serialargs_get_session_from_handle(&ctrlargs, client, &session);
6924daf39b3SJens Wiklander 	if (rc)
6934daf39b3SJens Wiklander 		return rc;
6946e4f8f17SEtienne Carriere 
6956e4f8f17SEtienne Carriere 	if (serialargs_remaining_bytes(&ctrlargs))
6966e4f8f17SEtienne Carriere 		return PKCS11_CKR_ARGUMENTS_BAD;
6976e4f8f17SEtienne Carriere 
6986e4f8f17SEtienne Carriere 	close_ck_session(session);
6996e4f8f17SEtienne Carriere 
7006e4f8f17SEtienne Carriere 	return PKCS11_CKR_OK;
7016e4f8f17SEtienne Carriere }
7026e4f8f17SEtienne Carriere 
7034daf39b3SJens Wiklander enum pkcs11_rc entry_ck_close_all_sessions(struct pkcs11_client *client,
7046e4f8f17SEtienne Carriere 					   uint32_t ptypes, TEE_Param *params)
7056e4f8f17SEtienne Carriere {
7066e4f8f17SEtienne Carriere 	const uint32_t exp_pt = TEE_PARAM_TYPES(TEE_PARAM_TYPE_MEMREF_INOUT,
7076e4f8f17SEtienne Carriere 						TEE_PARAM_TYPE_NONE,
7086e4f8f17SEtienne Carriere 						TEE_PARAM_TYPE_NONE,
7096e4f8f17SEtienne Carriere 						TEE_PARAM_TYPE_NONE);
71039b43b78SJens Wiklander 	TEE_Param *ctrl = params;
7114daf39b3SJens Wiklander 	enum pkcs11_rc rc = PKCS11_CKR_OK;
7126e4f8f17SEtienne Carriere 	struct serialargs ctrlargs = { };
7136e4f8f17SEtienne Carriere 	uint32_t token_id = 0;
7146e4f8f17SEtienne Carriere 	struct ck_token *token = NULL;
7156e4f8f17SEtienne Carriere 	struct pkcs11_session *session = NULL;
7166e4f8f17SEtienne Carriere 	struct pkcs11_session *next = NULL;
7176e4f8f17SEtienne Carriere 
7186e4f8f17SEtienne Carriere 	if (!client || ptypes != exp_pt)
7196e4f8f17SEtienne Carriere 		return PKCS11_CKR_ARGUMENTS_BAD;
7206e4f8f17SEtienne Carriere 
7216e4f8f17SEtienne Carriere 	serialargs_init(&ctrlargs, ctrl->memref.buffer, ctrl->memref.size);
7226e4f8f17SEtienne Carriere 
7234daf39b3SJens Wiklander 	rc = serialargs_get(&ctrlargs, &token_id, sizeof(uint32_t));
7244daf39b3SJens Wiklander 	if (rc)
7254daf39b3SJens Wiklander 		return rc;
7266e4f8f17SEtienne Carriere 
7276e4f8f17SEtienne Carriere 	if (serialargs_remaining_bytes(&ctrlargs))
7286e4f8f17SEtienne Carriere 		return PKCS11_CKR_ARGUMENTS_BAD;
7296e4f8f17SEtienne Carriere 
7306e4f8f17SEtienne Carriere 	token = get_token(token_id);
7316e4f8f17SEtienne Carriere 	if (!token)
7326e4f8f17SEtienne Carriere 		return PKCS11_CKR_SLOT_ID_INVALID;
7336e4f8f17SEtienne Carriere 
7346e4f8f17SEtienne Carriere 	DMSG("Close all sessions for PKCS11 token %"PRIu32, token_id);
7356e4f8f17SEtienne Carriere 
7366e4f8f17SEtienne Carriere 	TAILQ_FOREACH_SAFE(session, &client->session_list, link, next)
7376e4f8f17SEtienne Carriere 		if (session->token == token)
7386e4f8f17SEtienne Carriere 			close_ck_session(session);
7396e4f8f17SEtienne Carriere 
7406e4f8f17SEtienne Carriere 	return PKCS11_CKR_OK;
7416e4f8f17SEtienne Carriere }
7426e4f8f17SEtienne Carriere 
7434daf39b3SJens Wiklander enum pkcs11_rc entry_ck_session_info(struct pkcs11_client *client,
7446e4f8f17SEtienne Carriere 				     uint32_t ptypes, TEE_Param *params)
7456e4f8f17SEtienne Carriere {
7466e4f8f17SEtienne Carriere 	const uint32_t exp_pt = TEE_PARAM_TYPES(TEE_PARAM_TYPE_MEMREF_INOUT,
7476e4f8f17SEtienne Carriere 						TEE_PARAM_TYPE_NONE,
7486e4f8f17SEtienne Carriere 						TEE_PARAM_TYPE_MEMREF_OUTPUT,
7496e4f8f17SEtienne Carriere 						TEE_PARAM_TYPE_NONE);
75039b43b78SJens Wiklander 	TEE_Param *ctrl = params;
75139b43b78SJens Wiklander 	TEE_Param *out = params + 2;
7524daf39b3SJens Wiklander 	enum pkcs11_rc rc = PKCS11_CKR_OK;
7536e4f8f17SEtienne Carriere 	struct serialargs ctrlargs = { };
7546e4f8f17SEtienne Carriere 	struct pkcs11_session *session = NULL;
7556e4f8f17SEtienne Carriere 	struct pkcs11_session_info info = {
7566e4f8f17SEtienne Carriere 		.flags = PKCS11_CKFSS_SERIAL_SESSION,
7576e4f8f17SEtienne Carriere 	};
7586e4f8f17SEtienne Carriere 
7596e4f8f17SEtienne Carriere 	if (!client || ptypes != exp_pt || out->memref.size != sizeof(info))
7606e4f8f17SEtienne Carriere 		return PKCS11_CKR_ARGUMENTS_BAD;
7616e4f8f17SEtienne Carriere 
7626e4f8f17SEtienne Carriere 	serialargs_init(&ctrlargs, ctrl->memref.buffer, ctrl->memref.size);
7636e4f8f17SEtienne Carriere 
7644daf39b3SJens Wiklander 	rc = serialargs_get_session_from_handle(&ctrlargs, client, &session);
7654daf39b3SJens Wiklander 	if (rc)
7664daf39b3SJens Wiklander 		return rc;
7676e4f8f17SEtienne Carriere 
7686e4f8f17SEtienne Carriere 	if (serialargs_remaining_bytes(&ctrlargs))
7696e4f8f17SEtienne Carriere 		return PKCS11_CKR_ARGUMENTS_BAD;
7706e4f8f17SEtienne Carriere 
7716e4f8f17SEtienne Carriere 	info.slot_id = get_token_id(session->token);
7726e4f8f17SEtienne Carriere 	info.state = session->state;
7736e4f8f17SEtienne Carriere 	if (pkcs11_session_is_read_write(session))
7746e4f8f17SEtienne Carriere 		info.flags |= PKCS11_CKFSS_RW_SESSION;
7756e4f8f17SEtienne Carriere 
7766e4f8f17SEtienne Carriere 	TEE_MemMove(out->memref.buffer, &info, sizeof(info));
7776e4f8f17SEtienne Carriere 
7786e4f8f17SEtienne Carriere 	DMSG("Get find on PKCS11 session %"PRIu32, session->handle);
7796e4f8f17SEtienne Carriere 
7806e4f8f17SEtienne Carriere 	return PKCS11_CKR_OK;
7816e4f8f17SEtienne Carriere }
782f485be04SJens Wiklander 
7834daf39b3SJens Wiklander enum pkcs11_rc entry_ck_token_initialize(uint32_t ptypes, TEE_Param *params)
784f485be04SJens Wiklander {
785f485be04SJens Wiklander 	const uint32_t exp_pt = TEE_PARAM_TYPES(TEE_PARAM_TYPE_MEMREF_INOUT,
786f485be04SJens Wiklander 						TEE_PARAM_TYPE_NONE,
787f485be04SJens Wiklander 						TEE_PARAM_TYPE_NONE,
788f485be04SJens Wiklander 						TEE_PARAM_TYPE_NONE);
789f485be04SJens Wiklander 	char label[PKCS11_TOKEN_LABEL_SIZE] = { 0 };
790f485be04SJens Wiklander 	struct pkcs11_client *client = NULL;
791f485be04SJens Wiklander 	struct pkcs11_session *sess = NULL;
792f485be04SJens Wiklander 	enum pkcs11_rc rc = PKCS11_CKR_OK;
793f485be04SJens Wiklander 	struct serialargs ctrlargs = { };
794f485be04SJens Wiklander 	struct ck_token *token = NULL;
795f485be04SJens Wiklander 	TEE_Param *ctrl = params;
796f485be04SJens Wiklander 	uint32_t token_id = 0;
797f485be04SJens Wiklander 	uint32_t pin_size = 0;
798f485be04SJens Wiklander 	void *pin = NULL;
799f485be04SJens Wiklander 
800f485be04SJens Wiklander 	if (ptypes != exp_pt)
801f485be04SJens Wiklander 		return PKCS11_CKR_ARGUMENTS_BAD;
802f485be04SJens Wiklander 
803f485be04SJens Wiklander 	serialargs_init(&ctrlargs, ctrl->memref.buffer, ctrl->memref.size);
804f485be04SJens Wiklander 
805f485be04SJens Wiklander 	rc = serialargs_get(&ctrlargs, &token_id, sizeof(uint32_t));
806f485be04SJens Wiklander 	if (rc)
807f485be04SJens Wiklander 		return rc;
808f485be04SJens Wiklander 
809f485be04SJens Wiklander 	rc = serialargs_get(&ctrlargs, &pin_size, sizeof(uint32_t));
810f485be04SJens Wiklander 	if (rc)
811f485be04SJens Wiklander 		return rc;
812f485be04SJens Wiklander 
813f485be04SJens Wiklander 	rc = serialargs_get(&ctrlargs, &label, PKCS11_TOKEN_LABEL_SIZE);
814f485be04SJens Wiklander 	if (rc)
815f485be04SJens Wiklander 		return rc;
816f485be04SJens Wiklander 
817f485be04SJens Wiklander 	rc = serialargs_get_ptr(&ctrlargs, &pin, pin_size);
818f485be04SJens Wiklander 	if (rc)
819f485be04SJens Wiklander 		return rc;
820f485be04SJens Wiklander 
821f485be04SJens Wiklander 	if (serialargs_remaining_bytes(&ctrlargs))
822f485be04SJens Wiklander 		return PKCS11_CKR_ARGUMENTS_BAD;
823f485be04SJens Wiklander 
824f485be04SJens Wiklander 	token = get_token(token_id);
825f485be04SJens Wiklander 	if (!token)
826f485be04SJens Wiklander 		return PKCS11_CKR_SLOT_ID_INVALID;
827f485be04SJens Wiklander 
828f485be04SJens Wiklander 	if (token->db_main->flags & PKCS11_CKFT_SO_PIN_LOCKED) {
829f485be04SJens Wiklander 		IMSG("Token %"PRIu32": SO PIN locked", token_id);
830f485be04SJens Wiklander 		return PKCS11_CKR_PIN_LOCKED;
831f485be04SJens Wiklander 	}
832f485be04SJens Wiklander 
833f485be04SJens Wiklander 	/* Check there's no open session on this token */
834f485be04SJens Wiklander 	TAILQ_FOREACH(client, &pkcs11_client_list, link)
835f485be04SJens Wiklander 		TAILQ_FOREACH(sess, &client->session_list, link)
836f485be04SJens Wiklander 			if (sess->token == token)
837f485be04SJens Wiklander 				return PKCS11_CKR_SESSION_EXISTS;
838f485be04SJens Wiklander 
839f485be04SJens Wiklander 	if (!token->db_main->so_pin_salt) {
840f485be04SJens Wiklander 		/*
841f485be04SJens Wiklander 		 * The spec doesn't permit returning
842f485be04SJens Wiklander 		 * PKCS11_CKR_PIN_LEN_RANGE for this function, take another
843f485be04SJens Wiklander 		 * error code.
844f485be04SJens Wiklander 		 */
845f485be04SJens Wiklander 		if (pin_size < PKCS11_TOKEN_PIN_SIZE_MIN ||
846f485be04SJens Wiklander 		    pin_size > PKCS11_TOKEN_PIN_SIZE_MAX)
847f485be04SJens Wiklander 			return PKCS11_CKR_ARGUMENTS_BAD;
848f485be04SJens Wiklander 
849f485be04SJens Wiklander 		rc = hash_pin(PKCS11_CKU_SO, pin, pin_size,
850f485be04SJens Wiklander 			      &token->db_main->so_pin_salt,
851f485be04SJens Wiklander 			      token->db_main->so_pin_hash);
852f485be04SJens Wiklander 		if (rc)
853f485be04SJens Wiklander 			return rc;
854f485be04SJens Wiklander 
855f485be04SJens Wiklander 		update_persistent_db(token);
856f485be04SJens Wiklander 
857f485be04SJens Wiklander 		goto inited;
858f485be04SJens Wiklander 	}
859f485be04SJens Wiklander 
860f485be04SJens Wiklander 	rc = verify_pin(PKCS11_CKU_SO, pin, pin_size,
861f485be04SJens Wiklander 			token->db_main->so_pin_salt,
862f485be04SJens Wiklander 			token->db_main->so_pin_hash);
863f485be04SJens Wiklander 	if (rc) {
864f485be04SJens Wiklander 		unsigned int pin_count = 0;
865f485be04SJens Wiklander 
866f485be04SJens Wiklander 		if (rc != PKCS11_CKR_PIN_INCORRECT)
867f485be04SJens Wiklander 			return rc;
868f485be04SJens Wiklander 
869f485be04SJens Wiklander 		token->db_main->flags |= PKCS11_CKFT_SO_PIN_COUNT_LOW;
870f485be04SJens Wiklander 		token->db_main->so_pin_count++;
871f485be04SJens Wiklander 
872f485be04SJens Wiklander 		pin_count = token->db_main->so_pin_count;
873f485be04SJens Wiklander 		if (pin_count == PKCS11_TOKEN_SO_PIN_COUNT_MAX - 1)
874f485be04SJens Wiklander 			token->db_main->flags |= PKCS11_CKFT_SO_PIN_FINAL_TRY;
875f485be04SJens Wiklander 		if (pin_count == PKCS11_TOKEN_SO_PIN_COUNT_MAX)
876f485be04SJens Wiklander 			token->db_main->flags |= PKCS11_CKFT_SO_PIN_LOCKED;
877f485be04SJens Wiklander 
878f485be04SJens Wiklander 		update_persistent_db(token);
879f485be04SJens Wiklander 
880f485be04SJens Wiklander 		return PKCS11_CKR_PIN_INCORRECT;
881f485be04SJens Wiklander 	}
882f485be04SJens Wiklander 
883f485be04SJens Wiklander 	token->db_main->flags &= ~(PKCS11_CKFT_SO_PIN_COUNT_LOW |
884f485be04SJens Wiklander 				   PKCS11_CKFT_SO_PIN_FINAL_TRY);
885f485be04SJens Wiklander 	token->db_main->so_pin_count = 0;
886f485be04SJens Wiklander 
887f485be04SJens Wiklander inited:
888f485be04SJens Wiklander 	TEE_MemMove(token->db_main->label, label, PKCS11_TOKEN_LABEL_SIZE);
889f485be04SJens Wiklander 	token->db_main->flags |= PKCS11_CKFT_TOKEN_INITIALIZED;
890f485be04SJens Wiklander 	/* Reset user PIN */
891f485be04SJens Wiklander 	token->db_main->user_pin_salt = 0;
892f485be04SJens Wiklander 	token->db_main->flags &= ~(PKCS11_CKFT_USER_PIN_INITIALIZED |
893f485be04SJens Wiklander 				   PKCS11_CKFT_USER_PIN_COUNT_LOW |
894f485be04SJens Wiklander 				   PKCS11_CKFT_USER_PIN_FINAL_TRY |
895f485be04SJens Wiklander 				   PKCS11_CKFT_USER_PIN_LOCKED |
896f485be04SJens Wiklander 				   PKCS11_CKFT_USER_PIN_TO_BE_CHANGED);
897f485be04SJens Wiklander 
898f485be04SJens Wiklander 	update_persistent_db(token);
899f485be04SJens Wiklander 
900f485be04SJens Wiklander 	IMSG("PKCS11 token %"PRIu32": initialized", token_id);
901f485be04SJens Wiklander 
902f485be04SJens Wiklander 	return PKCS11_CKR_OK;
903f485be04SJens Wiklander }
904e8dbd92cSJens Wiklander 
905e8dbd92cSJens Wiklander static enum pkcs11_rc set_pin(struct pkcs11_session *session,
906e8dbd92cSJens Wiklander 			      uint8_t *new_pin, size_t new_pin_size,
907e8dbd92cSJens Wiklander 			      enum pkcs11_user_type user_type)
908e8dbd92cSJens Wiklander {
909e8dbd92cSJens Wiklander 	enum pkcs11_rc rc = PKCS11_CKR_OK;
910e8dbd92cSJens Wiklander 	uint32_t flags_clear = 0;
911e8dbd92cSJens Wiklander 	uint32_t flags_set = 0;
912e8dbd92cSJens Wiklander 
913e8dbd92cSJens Wiklander 	if (session->token->db_main->flags & PKCS11_CKFT_WRITE_PROTECTED)
914e8dbd92cSJens Wiklander 		return PKCS11_CKR_TOKEN_WRITE_PROTECTED;
915e8dbd92cSJens Wiklander 
916e8dbd92cSJens Wiklander 	if (!pkcs11_session_is_read_write(session))
917e8dbd92cSJens Wiklander 		return PKCS11_CKR_SESSION_READ_ONLY;
918e8dbd92cSJens Wiklander 
919e8dbd92cSJens Wiklander 	if (new_pin_size < PKCS11_TOKEN_PIN_SIZE_MIN ||
920e8dbd92cSJens Wiklander 	    new_pin_size > PKCS11_TOKEN_PIN_SIZE_MAX)
921e8dbd92cSJens Wiklander 		return PKCS11_CKR_PIN_LEN_RANGE;
922e8dbd92cSJens Wiklander 
923e8dbd92cSJens Wiklander 	switch (user_type) {
924e8dbd92cSJens Wiklander 	case PKCS11_CKU_SO:
925e8dbd92cSJens Wiklander 		rc = hash_pin(user_type, new_pin, new_pin_size,
926e8dbd92cSJens Wiklander 			      &session->token->db_main->so_pin_salt,
927e8dbd92cSJens Wiklander 			      session->token->db_main->so_pin_hash);
928e8dbd92cSJens Wiklander 		if (rc)
929e8dbd92cSJens Wiklander 			return rc;
930e8dbd92cSJens Wiklander 		session->token->db_main->so_pin_count = 0;
931e8dbd92cSJens Wiklander 		flags_clear = PKCS11_CKFT_SO_PIN_COUNT_LOW |
932e8dbd92cSJens Wiklander 			      PKCS11_CKFT_SO_PIN_FINAL_TRY |
933e8dbd92cSJens Wiklander 			      PKCS11_CKFT_SO_PIN_LOCKED |
934e8dbd92cSJens Wiklander 			      PKCS11_CKFT_SO_PIN_TO_BE_CHANGED;
935e8dbd92cSJens Wiklander 		break;
936e8dbd92cSJens Wiklander 	case PKCS11_CKU_USER:
937e8dbd92cSJens Wiklander 		rc = hash_pin(user_type, new_pin, new_pin_size,
938e8dbd92cSJens Wiklander 			      &session->token->db_main->user_pin_salt,
939e8dbd92cSJens Wiklander 			      session->token->db_main->user_pin_hash);
940e8dbd92cSJens Wiklander 		if (rc)
941e8dbd92cSJens Wiklander 			return rc;
942e8dbd92cSJens Wiklander 		session->token->db_main->user_pin_count = 0;
943e8dbd92cSJens Wiklander 		flags_clear = PKCS11_CKFT_USER_PIN_COUNT_LOW |
944e8dbd92cSJens Wiklander 			      PKCS11_CKFT_USER_PIN_FINAL_TRY |
945e8dbd92cSJens Wiklander 			      PKCS11_CKFT_USER_PIN_LOCKED |
946e8dbd92cSJens Wiklander 			      PKCS11_CKFT_USER_PIN_TO_BE_CHANGED;
947e8dbd92cSJens Wiklander 		flags_set = PKCS11_CKFT_USER_PIN_INITIALIZED;
948e8dbd92cSJens Wiklander 		break;
949e8dbd92cSJens Wiklander 	default:
950e8dbd92cSJens Wiklander 		return PKCS11_CKR_FUNCTION_FAILED;
951e8dbd92cSJens Wiklander 	}
952e8dbd92cSJens Wiklander 
953e8dbd92cSJens Wiklander 	session->token->db_main->flags &= ~flags_clear;
954e8dbd92cSJens Wiklander 	session->token->db_main->flags |= flags_set;
955e8dbd92cSJens Wiklander 
956e8dbd92cSJens Wiklander 	update_persistent_db(session->token);
957e8dbd92cSJens Wiklander 
958e8dbd92cSJens Wiklander 	return PKCS11_CKR_OK;
959e8dbd92cSJens Wiklander }
960e8dbd92cSJens Wiklander 
9614daf39b3SJens Wiklander enum pkcs11_rc entry_ck_init_pin(struct pkcs11_client *client,
962e8dbd92cSJens Wiklander 				 uint32_t ptypes, TEE_Param *params)
963e8dbd92cSJens Wiklander {
964e8dbd92cSJens Wiklander 	const uint32_t exp_pt = TEE_PARAM_TYPES(TEE_PARAM_TYPE_MEMREF_INOUT,
965e8dbd92cSJens Wiklander 						TEE_PARAM_TYPE_NONE,
966e8dbd92cSJens Wiklander 						TEE_PARAM_TYPE_NONE,
967e8dbd92cSJens Wiklander 						TEE_PARAM_TYPE_NONE);
968e8dbd92cSJens Wiklander 	struct pkcs11_session *session = NULL;
969e8dbd92cSJens Wiklander 	enum pkcs11_rc rc = PKCS11_CKR_OK;
970e8dbd92cSJens Wiklander 	struct serialargs ctrlargs = { };
971e8dbd92cSJens Wiklander 	TEE_Param *ctrl = params;
972e8dbd92cSJens Wiklander 	uint32_t pin_size = 0;
973e8dbd92cSJens Wiklander 	void *pin = NULL;
974e8dbd92cSJens Wiklander 
975e8dbd92cSJens Wiklander 	if (!client || ptypes != exp_pt)
976e8dbd92cSJens Wiklander 		return PKCS11_CKR_ARGUMENTS_BAD;
977e8dbd92cSJens Wiklander 
978e8dbd92cSJens Wiklander 	serialargs_init(&ctrlargs, ctrl->memref.buffer, ctrl->memref.size);
979e8dbd92cSJens Wiklander 
980f40f331fSEtienne Carriere 	rc = serialargs_get_session_from_handle(&ctrlargs, client, &session);
981e8dbd92cSJens Wiklander 	if (rc)
982e8dbd92cSJens Wiklander 		return rc;
983e8dbd92cSJens Wiklander 
984e8dbd92cSJens Wiklander 	rc = serialargs_get(&ctrlargs, &pin_size, sizeof(uint32_t));
985e8dbd92cSJens Wiklander 	if (rc)
986e8dbd92cSJens Wiklander 		return rc;
987e8dbd92cSJens Wiklander 
988e8dbd92cSJens Wiklander 	rc = serialargs_get_ptr(&ctrlargs, &pin, pin_size);
989e8dbd92cSJens Wiklander 	if (rc)
990e8dbd92cSJens Wiklander 		return rc;
991e8dbd92cSJens Wiklander 
992e8dbd92cSJens Wiklander 	if (serialargs_remaining_bytes(&ctrlargs))
993e8dbd92cSJens Wiklander 		return PKCS11_CKR_ARGUMENTS_BAD;
994e8dbd92cSJens Wiklander 
995e8dbd92cSJens Wiklander 	if (!pkcs11_session_is_so(session))
996e8dbd92cSJens Wiklander 		return PKCS11_CKR_USER_NOT_LOGGED_IN;
997e8dbd92cSJens Wiklander 
998e8dbd92cSJens Wiklander 	assert(session->token->db_main->flags & PKCS11_CKFT_TOKEN_INITIALIZED);
999e8dbd92cSJens Wiklander 
1000f40f331fSEtienne Carriere 	IMSG("PKCS11 session %"PRIu32": init PIN", session->handle);
1001e8dbd92cSJens Wiklander 
1002e8dbd92cSJens Wiklander 	return set_pin(session, pin, pin_size, PKCS11_CKU_USER);
1003e8dbd92cSJens Wiklander }
10041dbb91e7SJens Wiklander 
10054daf39b3SJens Wiklander static enum pkcs11_rc check_so_pin(struct pkcs11_session *session,
10061dbb91e7SJens Wiklander 				   uint8_t *pin, size_t pin_size)
10071dbb91e7SJens Wiklander {
10081dbb91e7SJens Wiklander 	struct ck_token *token = session->token;
10091dbb91e7SJens Wiklander 	enum pkcs11_rc rc = PKCS11_CKR_OK;
10101dbb91e7SJens Wiklander 
10111dbb91e7SJens Wiklander 	assert(token->db_main->flags & PKCS11_CKFT_TOKEN_INITIALIZED);
10121dbb91e7SJens Wiklander 
10131dbb91e7SJens Wiklander 	if (token->db_main->flags & PKCS11_CKFT_SO_PIN_LOCKED)
10141dbb91e7SJens Wiklander 		return PKCS11_CKR_PIN_LOCKED;
10151dbb91e7SJens Wiklander 
10161dbb91e7SJens Wiklander 	rc = verify_pin(PKCS11_CKU_SO, pin, pin_size,
10171dbb91e7SJens Wiklander 			token->db_main->so_pin_salt,
10181dbb91e7SJens Wiklander 			token->db_main->so_pin_hash);
10191dbb91e7SJens Wiklander 	if (rc) {
10201dbb91e7SJens Wiklander 		unsigned int pin_count = 0;
10211dbb91e7SJens Wiklander 
10221dbb91e7SJens Wiklander 		if (rc != PKCS11_CKR_PIN_INCORRECT)
10231dbb91e7SJens Wiklander 			return rc;
10241dbb91e7SJens Wiklander 
10251dbb91e7SJens Wiklander 		token->db_main->flags |= PKCS11_CKFT_SO_PIN_COUNT_LOW;
10261dbb91e7SJens Wiklander 		token->db_main->so_pin_count++;
10271dbb91e7SJens Wiklander 
10281dbb91e7SJens Wiklander 		pin_count = token->db_main->so_pin_count;
10291dbb91e7SJens Wiklander 		if (pin_count == PKCS11_TOKEN_SO_PIN_COUNT_MAX - 1)
10301dbb91e7SJens Wiklander 			token->db_main->flags |= PKCS11_CKFT_SO_PIN_FINAL_TRY;
10311dbb91e7SJens Wiklander 		if (pin_count == PKCS11_TOKEN_SO_PIN_COUNT_MAX)
10321dbb91e7SJens Wiklander 			token->db_main->flags |= PKCS11_CKFT_SO_PIN_LOCKED;
10331dbb91e7SJens Wiklander 
10341dbb91e7SJens Wiklander 		update_persistent_db(token);
10351dbb91e7SJens Wiklander 
10361dbb91e7SJens Wiklander 		if (token->db_main->flags & PKCS11_CKFT_SO_PIN_LOCKED)
10371dbb91e7SJens Wiklander 			return PKCS11_CKR_PIN_LOCKED;
10381dbb91e7SJens Wiklander 
10391dbb91e7SJens Wiklander 		return PKCS11_CKR_PIN_INCORRECT;
10401dbb91e7SJens Wiklander 	}
10411dbb91e7SJens Wiklander 
10421dbb91e7SJens Wiklander 	if (token->db_main->so_pin_count) {
10431dbb91e7SJens Wiklander 		token->db_main->so_pin_count = 0;
10441dbb91e7SJens Wiklander 
10451dbb91e7SJens Wiklander 		update_persistent_db(token);
10461dbb91e7SJens Wiklander 	}
10471dbb91e7SJens Wiklander 
10481dbb91e7SJens Wiklander 	if (token->db_main->flags & (PKCS11_CKFT_SO_PIN_COUNT_LOW |
10491dbb91e7SJens Wiklander 				     PKCS11_CKFT_SO_PIN_FINAL_TRY)) {
10501dbb91e7SJens Wiklander 		token->db_main->flags &= ~(PKCS11_CKFT_SO_PIN_COUNT_LOW |
10511dbb91e7SJens Wiklander 					   PKCS11_CKFT_SO_PIN_FINAL_TRY);
10521dbb91e7SJens Wiklander 
10531dbb91e7SJens Wiklander 		update_persistent_db(token);
10541dbb91e7SJens Wiklander 	}
10551dbb91e7SJens Wiklander 
10561dbb91e7SJens Wiklander 	return PKCS11_CKR_OK;
10571dbb91e7SJens Wiklander }
10581dbb91e7SJens Wiklander 
10594daf39b3SJens Wiklander static enum pkcs11_rc check_user_pin(struct pkcs11_session *session,
10601dbb91e7SJens Wiklander 				     uint8_t *pin, size_t pin_size)
10611dbb91e7SJens Wiklander {
10621dbb91e7SJens Wiklander 	struct ck_token *token = session->token;
10631dbb91e7SJens Wiklander 	enum pkcs11_rc rc = PKCS11_CKR_OK;
10641dbb91e7SJens Wiklander 
10651dbb91e7SJens Wiklander 	if (!token->db_main->user_pin_salt)
10661dbb91e7SJens Wiklander 		return PKCS11_CKR_USER_PIN_NOT_INITIALIZED;
10671dbb91e7SJens Wiklander 
10681dbb91e7SJens Wiklander 	if (token->db_main->flags & PKCS11_CKFT_USER_PIN_LOCKED)
10691dbb91e7SJens Wiklander 		return PKCS11_CKR_PIN_LOCKED;
10701dbb91e7SJens Wiklander 
10711dbb91e7SJens Wiklander 	rc = verify_pin(PKCS11_CKU_USER, pin, pin_size,
10721dbb91e7SJens Wiklander 			token->db_main->user_pin_salt,
10731dbb91e7SJens Wiklander 			token->db_main->user_pin_hash);
10741dbb91e7SJens Wiklander 	if (rc) {
10751dbb91e7SJens Wiklander 		unsigned int pin_count = 0;
10761dbb91e7SJens Wiklander 
10771dbb91e7SJens Wiklander 		if (rc != PKCS11_CKR_PIN_INCORRECT)
10781dbb91e7SJens Wiklander 			return rc;
10791dbb91e7SJens Wiklander 
10801dbb91e7SJens Wiklander 		token->db_main->flags |= PKCS11_CKFT_USER_PIN_COUNT_LOW;
10811dbb91e7SJens Wiklander 		token->db_main->user_pin_count++;
10821dbb91e7SJens Wiklander 
10831dbb91e7SJens Wiklander 		pin_count = token->db_main->user_pin_count;
10841dbb91e7SJens Wiklander 		if (pin_count == PKCS11_TOKEN_USER_PIN_COUNT_MAX - 1)
10851dbb91e7SJens Wiklander 			token->db_main->flags |= PKCS11_CKFT_USER_PIN_FINAL_TRY;
10861dbb91e7SJens Wiklander 		if (pin_count == PKCS11_TOKEN_USER_PIN_COUNT_MAX)
10871dbb91e7SJens Wiklander 			token->db_main->flags |= PKCS11_CKFT_USER_PIN_LOCKED;
10881dbb91e7SJens Wiklander 
10891dbb91e7SJens Wiklander 		update_persistent_db(token);
10901dbb91e7SJens Wiklander 
10911dbb91e7SJens Wiklander 		if (token->db_main->flags & PKCS11_CKFT_USER_PIN_LOCKED)
10921dbb91e7SJens Wiklander 			return PKCS11_CKR_PIN_LOCKED;
10931dbb91e7SJens Wiklander 
10941dbb91e7SJens Wiklander 		return PKCS11_CKR_PIN_INCORRECT;
10951dbb91e7SJens Wiklander 	}
10961dbb91e7SJens Wiklander 
10971dbb91e7SJens Wiklander 	if (token->db_main->user_pin_count) {
10981dbb91e7SJens Wiklander 		token->db_main->user_pin_count = 0;
10991dbb91e7SJens Wiklander 
11001dbb91e7SJens Wiklander 		update_persistent_db(token);
11011dbb91e7SJens Wiklander 	}
11021dbb91e7SJens Wiklander 
11031dbb91e7SJens Wiklander 	if (token->db_main->flags & (PKCS11_CKFT_USER_PIN_COUNT_LOW |
11041dbb91e7SJens Wiklander 				     PKCS11_CKFT_USER_PIN_FINAL_TRY)) {
11051dbb91e7SJens Wiklander 		token->db_main->flags &= ~(PKCS11_CKFT_USER_PIN_COUNT_LOW |
11061dbb91e7SJens Wiklander 					   PKCS11_CKFT_USER_PIN_FINAL_TRY);
11071dbb91e7SJens Wiklander 
11081dbb91e7SJens Wiklander 		update_persistent_db(token);
11091dbb91e7SJens Wiklander 	}
11101dbb91e7SJens Wiklander 
11111dbb91e7SJens Wiklander 	return PKCS11_CKR_OK;
11121dbb91e7SJens Wiklander }
11131dbb91e7SJens Wiklander 
11144daf39b3SJens Wiklander enum pkcs11_rc entry_ck_set_pin(struct pkcs11_client *client,
11151dbb91e7SJens Wiklander 				uint32_t ptypes, TEE_Param *params)
11161dbb91e7SJens Wiklander {
11171dbb91e7SJens Wiklander 	const uint32_t exp_pt = TEE_PARAM_TYPES(TEE_PARAM_TYPE_MEMREF_INOUT,
11181dbb91e7SJens Wiklander 						TEE_PARAM_TYPE_NONE,
11191dbb91e7SJens Wiklander 						TEE_PARAM_TYPE_NONE,
11201dbb91e7SJens Wiklander 						TEE_PARAM_TYPE_NONE);
11211dbb91e7SJens Wiklander 	struct pkcs11_session *session = NULL;
11221dbb91e7SJens Wiklander 	enum pkcs11_rc rc = PKCS11_CKR_OK;
11231dbb91e7SJens Wiklander 	struct serialargs ctrlargs = { };
11241dbb91e7SJens Wiklander 	uint32_t old_pin_size = 0;
11251dbb91e7SJens Wiklander 	TEE_Param *ctrl = params;
11261dbb91e7SJens Wiklander 	uint32_t pin_size = 0;
11271dbb91e7SJens Wiklander 	void *old_pin = NULL;
11281dbb91e7SJens Wiklander 	void *pin = NULL;
11291dbb91e7SJens Wiklander 
11301dbb91e7SJens Wiklander 	if (!client || ptypes != exp_pt)
11311dbb91e7SJens Wiklander 		return PKCS11_CKR_ARGUMENTS_BAD;
11321dbb91e7SJens Wiklander 
11331dbb91e7SJens Wiklander 	serialargs_init(&ctrlargs, ctrl->memref.buffer, ctrl->memref.size);
11341dbb91e7SJens Wiklander 
1135f40f331fSEtienne Carriere 	rc = serialargs_get_session_from_handle(&ctrlargs, client, &session);
11361dbb91e7SJens Wiklander 	if (rc)
11371dbb91e7SJens Wiklander 		return rc;
11381dbb91e7SJens Wiklander 
11391dbb91e7SJens Wiklander 	rc = serialargs_get(&ctrlargs, &old_pin_size, sizeof(uint32_t));
11401dbb91e7SJens Wiklander 	if (rc)
11411dbb91e7SJens Wiklander 		return rc;
11421dbb91e7SJens Wiklander 
11431dbb91e7SJens Wiklander 	rc = serialargs_get(&ctrlargs, &pin_size, sizeof(uint32_t));
11441dbb91e7SJens Wiklander 	if (rc)
11451dbb91e7SJens Wiklander 		return rc;
11461dbb91e7SJens Wiklander 
11471dbb91e7SJens Wiklander 	rc = serialargs_get_ptr(&ctrlargs, &old_pin, old_pin_size);
11481dbb91e7SJens Wiklander 	if (rc)
11491dbb91e7SJens Wiklander 		return rc;
11501dbb91e7SJens Wiklander 
11511dbb91e7SJens Wiklander 	rc = serialargs_get_ptr(&ctrlargs, &pin, pin_size);
11521dbb91e7SJens Wiklander 	if (rc)
11531dbb91e7SJens Wiklander 		return rc;
11541dbb91e7SJens Wiklander 
11551dbb91e7SJens Wiklander 	if (serialargs_remaining_bytes(&ctrlargs))
11561dbb91e7SJens Wiklander 		return PKCS11_CKR_ARGUMENTS_BAD;
11571dbb91e7SJens Wiklander 
11581dbb91e7SJens Wiklander 	if (!pkcs11_session_is_read_write(session))
11591dbb91e7SJens Wiklander 		return PKCS11_CKR_SESSION_READ_ONLY;
11601dbb91e7SJens Wiklander 
11611dbb91e7SJens Wiklander 	if (pkcs11_session_is_so(session)) {
11621dbb91e7SJens Wiklander 		if (!(session->token->db_main->flags &
11631dbb91e7SJens Wiklander 		      PKCS11_CKFT_TOKEN_INITIALIZED))
11641dbb91e7SJens Wiklander 			return PKCS11_CKR_GENERAL_ERROR;
11651dbb91e7SJens Wiklander 
11661dbb91e7SJens Wiklander 		rc = check_so_pin(session, old_pin, old_pin_size);
11671dbb91e7SJens Wiklander 		if (rc)
11681dbb91e7SJens Wiklander 			return rc;
11691dbb91e7SJens Wiklander 
1170f40f331fSEtienne Carriere 		IMSG("PKCS11 session %"PRIu32": set PIN", session->handle);
11711dbb91e7SJens Wiklander 
11721dbb91e7SJens Wiklander 		return set_pin(session, pin, pin_size, PKCS11_CKU_SO);
11731dbb91e7SJens Wiklander 	}
11741dbb91e7SJens Wiklander 
11751dbb91e7SJens Wiklander 	if (!(session->token->db_main->flags &
11761dbb91e7SJens Wiklander 	      PKCS11_CKFT_USER_PIN_INITIALIZED))
11771dbb91e7SJens Wiklander 		return PKCS11_CKR_GENERAL_ERROR;
11781dbb91e7SJens Wiklander 
11791dbb91e7SJens Wiklander 	rc = check_user_pin(session, old_pin, old_pin_size);
11801dbb91e7SJens Wiklander 	if (rc)
11811dbb91e7SJens Wiklander 		return rc;
11821dbb91e7SJens Wiklander 
1183f40f331fSEtienne Carriere 	IMSG("PKCS11 session %"PRIu32": set PIN", session->handle);
11841dbb91e7SJens Wiklander 
11851dbb91e7SJens Wiklander 	return set_pin(session, pin, pin_size, PKCS11_CKU_USER);
11861dbb91e7SJens Wiklander }
1187f7cc36c0SJens Wiklander 
1188f7cc36c0SJens Wiklander static void session_login_user(struct pkcs11_session *session)
1189f7cc36c0SJens Wiklander {
1190f7cc36c0SJens Wiklander 	struct pkcs11_client *client = session->client;
1191f7cc36c0SJens Wiklander 	struct pkcs11_session *sess = NULL;
1192f7cc36c0SJens Wiklander 
1193f7cc36c0SJens Wiklander 	TAILQ_FOREACH(sess, &client->session_list, link) {
1194f7cc36c0SJens Wiklander 		if (sess->token != session->token)
1195f7cc36c0SJens Wiklander 			continue;
1196f7cc36c0SJens Wiklander 
1197f7cc36c0SJens Wiklander 		if (pkcs11_session_is_read_write(sess))
1198f7cc36c0SJens Wiklander 			sess->state = PKCS11_CKS_RW_USER_FUNCTIONS;
1199f7cc36c0SJens Wiklander 		else
1200f7cc36c0SJens Wiklander 			sess->state = PKCS11_CKS_RO_USER_FUNCTIONS;
1201f7cc36c0SJens Wiklander 	}
1202f7cc36c0SJens Wiklander }
1203f7cc36c0SJens Wiklander 
1204f7cc36c0SJens Wiklander static void session_login_so(struct pkcs11_session *session)
1205f7cc36c0SJens Wiklander {
1206f7cc36c0SJens Wiklander 	struct pkcs11_client *client = session->client;
1207f7cc36c0SJens Wiklander 	struct pkcs11_session *sess = NULL;
1208f7cc36c0SJens Wiklander 
1209f7cc36c0SJens Wiklander 	TAILQ_FOREACH(sess, &client->session_list, link) {
1210f7cc36c0SJens Wiklander 		if (sess->token != session->token)
1211f7cc36c0SJens Wiklander 			continue;
1212f7cc36c0SJens Wiklander 
1213f7cc36c0SJens Wiklander 		if (pkcs11_session_is_read_write(sess))
1214f7cc36c0SJens Wiklander 			sess->state = PKCS11_CKS_RW_SO_FUNCTIONS;
1215f7cc36c0SJens Wiklander 		else
1216f7cc36c0SJens Wiklander 			TEE_Panic(0);
1217f7cc36c0SJens Wiklander 	}
1218f7cc36c0SJens Wiklander }
1219f7cc36c0SJens Wiklander 
1220f7cc36c0SJens Wiklander static void session_logout(struct pkcs11_session *session)
1221f7cc36c0SJens Wiklander {
1222f7cc36c0SJens Wiklander 	struct pkcs11_client *client = session->client;
1223f7cc36c0SJens Wiklander 	struct pkcs11_session *sess = NULL;
1224f7cc36c0SJens Wiklander 
1225f7cc36c0SJens Wiklander 	TAILQ_FOREACH(sess, &client->session_list, link) {
1226f7cc36c0SJens Wiklander 		if (sess->token != session->token)
1227f7cc36c0SJens Wiklander 			continue;
1228f7cc36c0SJens Wiklander 
1229f7cc36c0SJens Wiklander 		if (pkcs11_session_is_read_write(sess))
1230f7cc36c0SJens Wiklander 			sess->state = PKCS11_CKS_RW_PUBLIC_SESSION;
1231f7cc36c0SJens Wiklander 		else
1232f7cc36c0SJens Wiklander 			sess->state = PKCS11_CKS_RO_PUBLIC_SESSION;
1233f7cc36c0SJens Wiklander 	}
1234f7cc36c0SJens Wiklander }
1235f7cc36c0SJens Wiklander 
12364daf39b3SJens Wiklander enum pkcs11_rc entry_ck_login(struct pkcs11_client *client,
1237f7cc36c0SJens Wiklander 			      uint32_t ptypes, TEE_Param *params)
1238f7cc36c0SJens Wiklander {
1239f7cc36c0SJens Wiklander 	const uint32_t exp_pt = TEE_PARAM_TYPES(TEE_PARAM_TYPE_MEMREF_INOUT,
1240f7cc36c0SJens Wiklander 						TEE_PARAM_TYPE_NONE,
1241f7cc36c0SJens Wiklander 						TEE_PARAM_TYPE_NONE,
1242f7cc36c0SJens Wiklander 						TEE_PARAM_TYPE_NONE);
1243f7cc36c0SJens Wiklander 	struct pkcs11_session *session = NULL;
1244f7cc36c0SJens Wiklander 	struct pkcs11_session *sess = NULL;
1245f7cc36c0SJens Wiklander 	enum pkcs11_rc rc = PKCS11_CKR_OK;
1246f7cc36c0SJens Wiklander 	struct serialargs ctrlargs = { };
1247f7cc36c0SJens Wiklander 	TEE_Param *ctrl = params;
1248f7cc36c0SJens Wiklander 	uint32_t user_type = 0;
1249f7cc36c0SJens Wiklander 	uint32_t pin_size = 0;
1250f7cc36c0SJens Wiklander 	void *pin = NULL;
1251f7cc36c0SJens Wiklander 
1252f7cc36c0SJens Wiklander 	if (!client || ptypes != exp_pt)
1253f7cc36c0SJens Wiklander 		return PKCS11_CKR_ARGUMENTS_BAD;
1254f7cc36c0SJens Wiklander 
1255f7cc36c0SJens Wiklander 	serialargs_init(&ctrlargs, ctrl->memref.buffer, ctrl->memref.size);
1256f7cc36c0SJens Wiklander 
1257f40f331fSEtienne Carriere 	rc = serialargs_get_session_from_handle(&ctrlargs, client, &session);
1258f7cc36c0SJens Wiklander 	if (rc)
1259f7cc36c0SJens Wiklander 		return rc;
1260f7cc36c0SJens Wiklander 
1261f7cc36c0SJens Wiklander 	rc = serialargs_get(&ctrlargs, &user_type, sizeof(uint32_t));
1262f7cc36c0SJens Wiklander 	if (rc)
1263f7cc36c0SJens Wiklander 		return rc;
1264f7cc36c0SJens Wiklander 
1265f7cc36c0SJens Wiklander 	rc = serialargs_get(&ctrlargs, &pin_size, sizeof(uint32_t));
1266f7cc36c0SJens Wiklander 	if (rc)
1267f7cc36c0SJens Wiklander 		return rc;
1268f7cc36c0SJens Wiklander 
1269f7cc36c0SJens Wiklander 	rc = serialargs_get_ptr(&ctrlargs, &pin, pin_size);
1270f7cc36c0SJens Wiklander 	if (rc)
1271f7cc36c0SJens Wiklander 		return rc;
1272f7cc36c0SJens Wiklander 
1273f7cc36c0SJens Wiklander 	if (serialargs_remaining_bytes(&ctrlargs))
1274f7cc36c0SJens Wiklander 		return PKCS11_CKR_ARGUMENTS_BAD;
1275f7cc36c0SJens Wiklander 
1276f7cc36c0SJens Wiklander 	switch (user_type) {
1277f7cc36c0SJens Wiklander 	case PKCS11_CKU_SO:
1278f7cc36c0SJens Wiklander 		if (pkcs11_session_is_so(session))
1279f7cc36c0SJens Wiklander 			return PKCS11_CKR_USER_ALREADY_LOGGED_IN;
1280f7cc36c0SJens Wiklander 
1281f7cc36c0SJens Wiklander 		if (pkcs11_session_is_user(session))
1282f7cc36c0SJens Wiklander 			return PKCS11_CKR_USER_ANOTHER_ALREADY_LOGGED_IN;
1283f7cc36c0SJens Wiklander 
1284f7cc36c0SJens Wiklander 		TAILQ_FOREACH(sess, &client->session_list, link)
1285f7cc36c0SJens Wiklander 			if (sess->token == session->token &&
1286f7cc36c0SJens Wiklander 			    !pkcs11_session_is_read_write(sess))
1287f7cc36c0SJens Wiklander 				return PKCS11_CKR_SESSION_READ_ONLY_EXISTS;
1288f7cc36c0SJens Wiklander 
1289f7cc36c0SJens Wiklander 		/*
1290f7cc36c0SJens Wiklander 		 * This is the point where we could check if another client
1291f7cc36c0SJens Wiklander 		 * has another user or SO logged in.
1292f7cc36c0SJens Wiklander 		 *
1293f7cc36c0SJens Wiklander 		 * The spec says:
1294f7cc36c0SJens Wiklander 		 * CKR_USER_TOO_MANY_TYPES: An attempt was made to have
1295f7cc36c0SJens Wiklander 		 * more distinct users simultaneously logged into the token
1296f7cc36c0SJens Wiklander 		 * than the token and/or library permits. For example, if
1297f7cc36c0SJens Wiklander 		 * some application has an open SO session, and another
1298f7cc36c0SJens Wiklander 		 * application attempts to log the normal user into a
1299f7cc36c0SJens Wiklander 		 * session, the attempt may return this error. It is not
1300f7cc36c0SJens Wiklander 		 * required to, however. Only if the simultaneous distinct
1301f7cc36c0SJens Wiklander 		 * users cannot be supported does C_Login have to return
1302f7cc36c0SJens Wiklander 		 * this value. Note that this error code generalizes to
1303f7cc36c0SJens Wiklander 		 * true multi-user tokens.
1304f7cc36c0SJens Wiklander 		 *
1305f7cc36c0SJens Wiklander 		 * So it's permitted to have another user or SO logged in
1306f7cc36c0SJens Wiklander 		 * from another client.
1307f7cc36c0SJens Wiklander 		 */
1308f7cc36c0SJens Wiklander 
1309f7cc36c0SJens Wiklander 		rc = check_so_pin(session, pin, pin_size);
1310f7cc36c0SJens Wiklander 		if (!rc)
1311f7cc36c0SJens Wiklander 			session_login_so(session);
1312f7cc36c0SJens Wiklander 
1313f7cc36c0SJens Wiklander 		break;
1314f7cc36c0SJens Wiklander 
1315f7cc36c0SJens Wiklander 	case PKCS11_CKU_USER:
1316f7cc36c0SJens Wiklander 		if (pkcs11_session_is_so(session))
1317f7cc36c0SJens Wiklander 			return PKCS11_CKR_USER_ANOTHER_ALREADY_LOGGED_IN;
1318f7cc36c0SJens Wiklander 
1319f7cc36c0SJens Wiklander 		if (pkcs11_session_is_user(session))
1320f7cc36c0SJens Wiklander 			return PKCS11_CKR_USER_ALREADY_LOGGED_IN;
1321f7cc36c0SJens Wiklander 
1322f7cc36c0SJens Wiklander 		/*
1323f7cc36c0SJens Wiklander 		 * This is the point where we could check if another client
1324f7cc36c0SJens Wiklander 		 * has another user or SO logged in.
1325f7cc36c0SJens Wiklander 		 * See comment on CKR_USER_TOO_MANY_TYPES above.
1326f7cc36c0SJens Wiklander 		 */
1327f7cc36c0SJens Wiklander 
1328f7cc36c0SJens Wiklander 		rc = check_user_pin(session, pin, pin_size);
1329f7cc36c0SJens Wiklander 		if (!rc)
1330f7cc36c0SJens Wiklander 			session_login_user(session);
1331f7cc36c0SJens Wiklander 
1332f7cc36c0SJens Wiklander 		break;
1333f7cc36c0SJens Wiklander 
1334f7cc36c0SJens Wiklander 	case PKCS11_CKU_CONTEXT_SPECIFIC:
1335f7cc36c0SJens Wiklander 		return PKCS11_CKR_OPERATION_NOT_INITIALIZED;
1336f7cc36c0SJens Wiklander 
1337f7cc36c0SJens Wiklander 	default:
1338f7cc36c0SJens Wiklander 		return PKCS11_CKR_USER_TYPE_INVALID;
1339f7cc36c0SJens Wiklander 	}
1340f7cc36c0SJens Wiklander 
1341f7cc36c0SJens Wiklander 	if (!rc)
1342f40f331fSEtienne Carriere 		IMSG("PKCS11 session %"PRIu32": login", session->handle);
1343f7cc36c0SJens Wiklander 
1344f7cc36c0SJens Wiklander 	return rc;
1345f7cc36c0SJens Wiklander }
1346f7cc36c0SJens Wiklander 
13474daf39b3SJens Wiklander enum pkcs11_rc entry_ck_logout(struct pkcs11_client *client,
1348f7cc36c0SJens Wiklander 			       uint32_t ptypes, TEE_Param *params)
1349f7cc36c0SJens Wiklander {
1350f7cc36c0SJens Wiklander 	const uint32_t exp_pt = TEE_PARAM_TYPES(TEE_PARAM_TYPE_MEMREF_INOUT,
1351f7cc36c0SJens Wiklander 						TEE_PARAM_TYPE_NONE,
1352f7cc36c0SJens Wiklander 						TEE_PARAM_TYPE_NONE,
1353f7cc36c0SJens Wiklander 						TEE_PARAM_TYPE_NONE);
1354f7cc36c0SJens Wiklander 	struct pkcs11_session *session = NULL;
1355f7cc36c0SJens Wiklander 	enum pkcs11_rc rc = PKCS11_CKR_OK;
1356f7cc36c0SJens Wiklander 	struct serialargs ctrlargs = { };
1357f7cc36c0SJens Wiklander 	TEE_Param *ctrl = params;
1358f7cc36c0SJens Wiklander 
1359f7cc36c0SJens Wiklander 	if (!client || ptypes != exp_pt)
1360f7cc36c0SJens Wiklander 		return PKCS11_CKR_ARGUMENTS_BAD;
1361f7cc36c0SJens Wiklander 
1362f7cc36c0SJens Wiklander 	serialargs_init(&ctrlargs, ctrl->memref.buffer, ctrl->memref.size);
1363f7cc36c0SJens Wiklander 
1364f40f331fSEtienne Carriere 	rc = serialargs_get_session_from_handle(&ctrlargs, client, &session);
1365f7cc36c0SJens Wiklander 	if (rc)
1366f7cc36c0SJens Wiklander 		return rc;
1367f7cc36c0SJens Wiklander 
1368f7cc36c0SJens Wiklander 	if (serialargs_remaining_bytes(&ctrlargs))
1369f7cc36c0SJens Wiklander 		return PKCS11_CKR_ARGUMENTS_BAD;
1370f7cc36c0SJens Wiklander 
1371f7cc36c0SJens Wiklander 	if (pkcs11_session_is_public(session))
1372f7cc36c0SJens Wiklander 		return PKCS11_CKR_USER_NOT_LOGGED_IN;
1373f7cc36c0SJens Wiklander 
1374f7cc36c0SJens Wiklander 	session_logout(session);
1375f7cc36c0SJens Wiklander 
1376f40f331fSEtienne Carriere 	IMSG("PKCS11 session %"PRIu32": logout", session->handle);
1377f7cc36c0SJens Wiklander 
1378f7cc36c0SJens Wiklander 	return PKCS11_CKR_OK;
1379f7cc36c0SJens Wiklander }
1380