Line | Count | Source (jump to first uncovered line) |
1 | | /* |
2 | | * Copyright (c) 2019-2022 Yubico AB. All rights reserved. |
3 | | * Use of this source code is governed by a BSD-style |
4 | | * license that can be found in the LICENSE file. |
5 | | * SPDX-License-Identifier: BSD-2-Clause |
6 | | */ |
7 | | |
8 | | #include "fido.h" |
9 | | #include "fido/bio.h" |
10 | | #include "fido/es256.h" |
11 | | |
12 | 3.93k | #define CMD_ENROLL_BEGIN 0x01 |
13 | 8.19k | #define CMD_ENROLL_NEXT 0x02 |
14 | 0 | #define CMD_ENROLL_CANCEL 0x03 |
15 | 14.6k | #define CMD_ENUM 0x04 |
16 | 11.4k | #define CMD_SET_NAME 0x05 |
17 | 8.31k | #define CMD_ENROLL_REMOVE 0x06 |
18 | 21.9k | #define CMD_GET_INFO 0x07 |
19 | | |
20 | | static int |
21 | | bio_prepare_hmac(uint8_t cmd, cbor_item_t **argv, size_t argc, |
22 | | cbor_item_t **param, fido_blob_t *hmac_data) |
23 | 44.9k | { |
24 | 44.9k | const uint8_t prefix[2] = { 0x01 /* modality */, cmd }; |
25 | 44.9k | int ok = -1; |
26 | 44.9k | size_t cbor_alloc_len; |
27 | 44.9k | size_t cbor_len; |
28 | 44.9k | unsigned char *cbor = NULL; |
29 | | |
30 | 44.9k | if (argv == NULL || param == NULL) |
31 | 14.6k | return (fido_blob_set(hmac_data, prefix, sizeof(prefix))); |
32 | | |
33 | 30.2k | if ((*param = cbor_flatten_vector(argv, argc)) == NULL) { |
34 | 1.29k | fido_log_debug("%s: cbor_flatten_vector", __func__); |
35 | 1.29k | goto fail; |
36 | 1.29k | } |
37 | | |
38 | 28.9k | if ((cbor_len = cbor_serialize_alloc(*param, &cbor, |
39 | 28.9k | &cbor_alloc_len)) == 0 || cbor_len > SIZE_MAX - sizeof(prefix)) { |
40 | 211 | fido_log_debug("%s: cbor_serialize_alloc", __func__); |
41 | 211 | goto fail; |
42 | 211 | } |
43 | | |
44 | 28.7k | if ((hmac_data->ptr = malloc(cbor_len + sizeof(prefix))) == NULL) { |
45 | 100 | fido_log_debug("%s: malloc", __func__); |
46 | 100 | goto fail; |
47 | 100 | } |
48 | | |
49 | 28.6k | memcpy(hmac_data->ptr, prefix, sizeof(prefix)); |
50 | 28.6k | memcpy(hmac_data->ptr + sizeof(prefix), cbor, cbor_len); |
51 | 28.6k | hmac_data->len = cbor_len + sizeof(prefix); |
52 | | |
53 | 28.6k | ok = 0; |
54 | 30.2k | fail: |
55 | 30.2k | free(cbor); |
56 | | |
57 | 30.2k | return (ok); |
58 | 28.6k | } |
59 | | |
60 | | static uint8_t |
61 | | bio_get_cmd(const fido_dev_t *dev) |
62 | 66.9k | { |
63 | 66.9k | if (dev->flags & (FIDO_DEV_BIO_SET|FIDO_DEV_BIO_UNSET)) |
64 | 1 | return (CTAP_CBOR_BIO_ENROLL); |
65 | | |
66 | 66.9k | return (CTAP_CBOR_BIO_ENROLL_PRE); |
67 | 66.9k | } |
68 | | |
69 | | static int |
70 | | bio_tx(fido_dev_t *dev, uint8_t subcmd, cbor_item_t **sub_argv, size_t sub_argc, |
71 | | const char *pin, const fido_blob_t *token, int *ms) |
72 | 66.9k | { |
73 | 66.9k | cbor_item_t *argv[5]; |
74 | 66.9k | es256_pk_t *pk = NULL; |
75 | 66.9k | fido_blob_t *ecdh = NULL; |
76 | 66.9k | fido_blob_t f; |
77 | 66.9k | fido_blob_t hmac; |
78 | 66.9k | const uint8_t cmd = bio_get_cmd(dev); |
79 | 66.9k | int r = FIDO_ERR_INTERNAL; |
80 | | |
81 | 66.9k | memset(&f, 0, sizeof(f)); |
82 | 66.9k | memset(&hmac, 0, sizeof(hmac)); |
83 | 66.9k | memset(&argv, 0, sizeof(argv)); |
84 | | |
85 | | /* modality, subCommand */ |
86 | 66.9k | if ((argv[0] = cbor_build_uint8(1)) == NULL || |
87 | 66.9k | (argv[1] = cbor_build_uint8(subcmd)) == NULL) { |
88 | 205 | fido_log_debug("%s: cbor encode", __func__); |
89 | 205 | goto fail; |
90 | 205 | } |
91 | | |
92 | | /* subParams */ |
93 | 66.7k | if (pin || token) { |
94 | 44.9k | if (bio_prepare_hmac(subcmd, sub_argv, sub_argc, &argv[2], |
95 | 44.9k | &hmac) < 0) { |
96 | 1.70k | fido_log_debug("%s: bio_prepare_hmac", __func__); |
97 | 1.70k | goto fail; |
98 | 1.70k | } |
99 | 44.9k | } |
100 | | |
101 | | /* pinProtocol, pinAuth */ |
102 | 65.0k | if (pin) { |
103 | 33.2k | if ((r = fido_do_ecdh(dev, &pk, &ecdh, ms)) != FIDO_OK) { |
104 | 26.0k | fido_log_debug("%s: fido_do_ecdh", __func__); |
105 | 26.0k | goto fail; |
106 | 26.0k | } |
107 | 7.17k | if ((r = cbor_add_uv_params(dev, cmd, &hmac, pk, ecdh, pin, |
108 | 7.17k | NULL, &argv[4], &argv[3], ms)) != FIDO_OK) { |
109 | 3.76k | fido_log_debug("%s: cbor_add_uv_params", __func__); |
110 | 3.76k | goto fail; |
111 | 3.76k | } |
112 | 31.8k | } else if (token) { |
113 | 9.99k | if ((argv[3] = cbor_encode_pin_opt(dev)) == NULL || |
114 | 9.99k | (argv[4] = cbor_encode_pin_auth(dev, token, &hmac)) == NULL) { |
115 | 793 | fido_log_debug("%s: encode pin", __func__); |
116 | 793 | goto fail; |
117 | 793 | } |
118 | 9.99k | } |
119 | | |
120 | | /* framing and transmission */ |
121 | 34.4k | if (cbor_build_frame(cmd, argv, nitems(argv), &f) < 0 || |
122 | 34.4k | fido_tx(dev, CTAP_CMD_CBOR, f.ptr, f.len, ms) < 0) { |
123 | 2.74k | fido_log_debug("%s: fido_tx", __func__); |
124 | 2.74k | r = FIDO_ERR_TX; |
125 | 2.74k | goto fail; |
126 | 2.74k | } |
127 | | |
128 | 31.7k | r = FIDO_OK; |
129 | 66.9k | fail: |
130 | 66.9k | cbor_vector_free(argv, nitems(argv)); |
131 | 66.9k | es256_pk_free(&pk); |
132 | 66.9k | fido_blob_free(&ecdh); |
133 | 66.9k | free(f.ptr); |
134 | 66.9k | free(hmac.ptr); |
135 | | |
136 | 66.9k | return (r); |
137 | 31.7k | } |
138 | | |
139 | | static void |
140 | | bio_reset_template(fido_bio_template_t *t) |
141 | 60.7k | { |
142 | 60.7k | free(t->name); |
143 | 60.7k | t->name = NULL; |
144 | 60.7k | fido_blob_reset(&t->id); |
145 | 60.7k | } |
146 | | |
147 | | static void |
148 | | bio_reset_template_array(fido_bio_template_array_t *ta) |
149 | 16.3k | { |
150 | 25.6k | for (size_t i = 0; i < ta->n_alloc; i++) |
151 | 9.37k | bio_reset_template(&ta->ptr[i]); |
152 | | |
153 | 16.3k | free(ta->ptr); |
154 | 16.3k | ta->ptr = NULL; |
155 | 16.3k | memset(ta, 0, sizeof(*ta)); |
156 | 16.3k | } |
157 | | |
158 | | static int |
159 | | decode_template(const cbor_item_t *key, const cbor_item_t *val, void *arg) |
160 | 3.07k | { |
161 | 3.07k | fido_bio_template_t *t = arg; |
162 | | |
163 | 3.07k | if (cbor_isa_uint(key) == false || |
164 | 3.07k | cbor_int_get_width(key) != CBOR_INT_8) { |
165 | 467 | fido_log_debug("%s: cbor type", __func__); |
166 | 467 | return (0); /* ignore */ |
167 | 467 | } |
168 | | |
169 | 2.60k | switch (cbor_get_uint8(key)) { |
170 | 1.27k | case 1: /* id */ |
171 | 1.27k | return (fido_blob_decode(val, &t->id)); |
172 | 1.18k | case 2: /* name */ |
173 | 1.18k | return (cbor_string_copy(val, &t->name)); |
174 | 2.60k | } |
175 | | |
176 | 147 | return (0); /* ignore */ |
177 | 2.60k | } |
178 | | |
179 | | static int |
180 | | decode_template_array(const cbor_item_t *item, void *arg) |
181 | 8.15k | { |
182 | 8.15k | fido_bio_template_array_t *ta = arg; |
183 | | |
184 | 8.15k | if (cbor_isa_map(item) == false || |
185 | 8.15k | cbor_map_is_definite(item) == false) { |
186 | 172 | fido_log_debug("%s: cbor type", __func__); |
187 | 172 | return (-1); |
188 | 172 | } |
189 | | |
190 | 7.98k | if (ta->n_rx >= ta->n_alloc) { |
191 | 0 | fido_log_debug("%s: n_rx >= n_alloc", __func__); |
192 | 0 | return (-1); |
193 | 0 | } |
194 | | |
195 | 7.98k | if (cbor_map_iter(item, &ta->ptr[ta->n_rx], decode_template) < 0) { |
196 | 273 | fido_log_debug("%s: decode_template", __func__); |
197 | 273 | return (-1); |
198 | 273 | } |
199 | | |
200 | 7.71k | ta->n_rx++; |
201 | | |
202 | 7.71k | return (0); |
203 | 7.98k | } |
204 | | |
205 | | static int |
206 | | bio_parse_template_array(const cbor_item_t *key, const cbor_item_t *val, |
207 | | void *arg) |
208 | 2.21k | { |
209 | 2.21k | fido_bio_template_array_t *ta = arg; |
210 | | |
211 | 2.21k | if (cbor_isa_uint(key) == false || |
212 | 2.21k | cbor_int_get_width(key) != CBOR_INT_8 || |
213 | 2.21k | cbor_get_uint8(key) != 7) { |
214 | 1.20k | fido_log_debug("%s: cbor type", __func__); |
215 | 1.20k | return (0); /* ignore */ |
216 | 1.20k | } |
217 | | |
218 | 1.01k | if (cbor_isa_array(val) == false || |
219 | 1.01k | cbor_array_is_definite(val) == false) { |
220 | 3 | fido_log_debug("%s: cbor type", __func__); |
221 | 3 | return (-1); |
222 | 3 | } |
223 | | |
224 | 1.01k | if (ta->ptr != NULL || ta->n_alloc != 0 || ta->n_rx != 0) { |
225 | 0 | fido_log_debug("%s: ptr != NULL || n_alloc != 0 || n_rx != 0", |
226 | 0 | __func__); |
227 | 0 | return (-1); |
228 | 0 | } |
229 | | |
230 | 1.01k | if ((ta->ptr = calloc(cbor_array_size(val), sizeof(*ta->ptr))) == NULL) |
231 | 64 | return (-1); |
232 | | |
233 | 947 | ta->n_alloc = cbor_array_size(val); |
234 | | |
235 | 947 | if (cbor_array_iter(val, ta, decode_template_array) < 0) { |
236 | 445 | fido_log_debug("%s: decode_template_array", __func__); |
237 | 445 | return (-1); |
238 | 445 | } |
239 | | |
240 | 502 | return (0); |
241 | 947 | } |
242 | | |
243 | | static int |
244 | | bio_rx_template_array(fido_dev_t *dev, fido_bio_template_array_t *ta, int *ms) |
245 | 1.66k | { |
246 | 1.66k | unsigned char *msg; |
247 | 1.66k | int msglen; |
248 | 1.66k | int r; |
249 | | |
250 | 1.66k | bio_reset_template_array(ta); |
251 | | |
252 | 1.66k | if ((msg = malloc(FIDO_MAXMSG)) == NULL) { |
253 | 32 | r = FIDO_ERR_INTERNAL; |
254 | 32 | goto out; |
255 | 32 | } |
256 | | |
257 | 1.63k | if ((msglen = fido_rx(dev, CTAP_CMD_CBOR, msg, FIDO_MAXMSG, ms)) < 0) { |
258 | 73 | fido_log_debug("%s: fido_rx", __func__); |
259 | 73 | r = FIDO_ERR_RX; |
260 | 73 | goto out; |
261 | 73 | } |
262 | | |
263 | 1.55k | if ((r = cbor_parse_reply(msg, (size_t)msglen, ta, |
264 | 1.55k | bio_parse_template_array)) != FIDO_OK) { |
265 | 1.02k | fido_log_debug("%s: bio_parse_template_array" , __func__); |
266 | 1.02k | goto out; |
267 | 1.02k | } |
268 | | |
269 | 538 | r = FIDO_OK; |
270 | 1.66k | out: |
271 | 1.66k | freezero(msg, FIDO_MAXMSG); |
272 | | |
273 | 1.66k | return (r); |
274 | 538 | } |
275 | | |
276 | | static int |
277 | | bio_get_template_array_wait(fido_dev_t *dev, fido_bio_template_array_t *ta, |
278 | | const char *pin, int *ms) |
279 | 14.6k | { |
280 | 14.6k | int r; |
281 | | |
282 | 14.6k | if ((r = bio_tx(dev, CMD_ENUM, NULL, 0, pin, NULL, ms)) != FIDO_OK || |
283 | 14.6k | (r = bio_rx_template_array(dev, ta, ms)) != FIDO_OK) |
284 | 14.1k | return (r); |
285 | | |
286 | 538 | return (FIDO_OK); |
287 | 14.6k | } |
288 | | |
289 | | int |
290 | | fido_bio_dev_get_template_array(fido_dev_t *dev, fido_bio_template_array_t *ta, |
291 | | const char *pin) |
292 | 14.6k | { |
293 | 14.6k | int ms = dev->timeout_ms; |
294 | | |
295 | 14.6k | if (pin == NULL) |
296 | 0 | return (FIDO_ERR_INVALID_ARGUMENT); |
297 | | |
298 | 14.6k | return (bio_get_template_array_wait(dev, ta, pin, &ms)); |
299 | 14.6k | } |
300 | | |
301 | | static int |
302 | | bio_set_template_name_wait(fido_dev_t *dev, const fido_bio_template_t *t, |
303 | | const char *pin, int *ms) |
304 | 11.6k | { |
305 | 11.6k | cbor_item_t *argv[2]; |
306 | 11.6k | int r = FIDO_ERR_INTERNAL; |
307 | | |
308 | 11.6k | memset(&argv, 0, sizeof(argv)); |
309 | | |
310 | 11.6k | if ((argv[0] = fido_blob_encode(&t->id)) == NULL || |
311 | 11.6k | (argv[1] = cbor_build_string(t->name)) == NULL) { |
312 | 157 | fido_log_debug("%s: cbor encode", __func__); |
313 | 157 | goto fail; |
314 | 157 | } |
315 | | |
316 | 11.4k | if ((r = bio_tx(dev, CMD_SET_NAME, argv, 2, pin, NULL, |
317 | 11.4k | ms)) != FIDO_OK || |
318 | 11.4k | (r = fido_rx_cbor_status(dev, ms)) != FIDO_OK) { |
319 | 11.3k | fido_log_debug("%s: tx/rx", __func__); |
320 | 11.3k | goto fail; |
321 | 11.3k | } |
322 | | |
323 | 131 | r = FIDO_OK; |
324 | 11.6k | fail: |
325 | 11.6k | cbor_vector_free(argv, nitems(argv)); |
326 | | |
327 | 11.6k | return (r); |
328 | 131 | } |
329 | | |
330 | | int |
331 | | fido_bio_dev_set_template_name(fido_dev_t *dev, const fido_bio_template_t *t, |
332 | | const char *pin) |
333 | 11.6k | { |
334 | 11.6k | int ms = dev->timeout_ms; |
335 | | |
336 | 11.6k | if (pin == NULL || t->name == NULL) |
337 | 62 | return (FIDO_ERR_INVALID_ARGUMENT); |
338 | | |
339 | 11.6k | return (bio_set_template_name_wait(dev, t, pin, &ms)); |
340 | 11.6k | } |
341 | | |
342 | | static void |
343 | | bio_reset_enroll(fido_bio_enroll_t *e) |
344 | 27.5k | { |
345 | 27.5k | e->remaining_samples = 0; |
346 | 27.5k | e->last_status = 0; |
347 | | |
348 | 27.5k | if (e->token) |
349 | 3.93k | fido_blob_free(&e->token); |
350 | 27.5k | } |
351 | | |
352 | | static int |
353 | | bio_parse_enroll_status(const cbor_item_t *key, const cbor_item_t *val, |
354 | | void *arg) |
355 | 12.9k | { |
356 | 12.9k | fido_bio_enroll_t *e = arg; |
357 | 12.9k | uint64_t x; |
358 | | |
359 | 12.9k | if (cbor_isa_uint(key) == false || |
360 | 12.9k | cbor_int_get_width(key) != CBOR_INT_8) { |
361 | 205 | fido_log_debug("%s: cbor type", __func__); |
362 | 205 | return (0); /* ignore */ |
363 | 205 | } |
364 | | |
365 | 12.7k | switch (cbor_get_uint8(key)) { |
366 | 4.59k | case 5: |
367 | 4.59k | if (cbor_decode_uint64(val, &x) < 0 || x > UINT8_MAX) { |
368 | 157 | fido_log_debug("%s: cbor_decode_uint64", __func__); |
369 | 157 | return (-1); |
370 | 157 | } |
371 | 4.43k | e->last_status = (uint8_t)x; |
372 | 4.43k | break; |
373 | 4.46k | case 6: |
374 | 4.46k | if (cbor_decode_uint64(val, &x) < 0 || x > UINT8_MAX) { |
375 | 219 | fido_log_debug("%s: cbor_decode_uint64", __func__); |
376 | 219 | return (-1); |
377 | 219 | } |
378 | 4.24k | e->remaining_samples = (uint8_t)x; |
379 | 4.24k | break; |
380 | 3.71k | default: |
381 | 3.71k | return (0); /* ignore */ |
382 | 12.7k | } |
383 | | |
384 | 8.68k | return (0); |
385 | 12.7k | } |
386 | | |
387 | | static int |
388 | | bio_parse_template_id(const cbor_item_t *key, const cbor_item_t *val, |
389 | | void *arg) |
390 | 8.00k | { |
391 | 8.00k | fido_blob_t *id = arg; |
392 | | |
393 | 8.00k | if (cbor_isa_uint(key) == false || |
394 | 8.00k | cbor_int_get_width(key) != CBOR_INT_8 || |
395 | 8.00k | cbor_get_uint8(key) != 4) { |
396 | 5.48k | fido_log_debug("%s: cbor type", __func__); |
397 | 5.48k | return (0); /* ignore */ |
398 | 5.48k | } |
399 | | |
400 | 2.52k | return (fido_blob_decode(val, id)); |
401 | 8.00k | } |
402 | | |
403 | | static int |
404 | | bio_rx_enroll_begin(fido_dev_t *dev, fido_bio_template_t *t, |
405 | | fido_bio_enroll_t *e, int *ms) |
406 | 3.69k | { |
407 | 3.69k | unsigned char *msg; |
408 | 3.69k | int msglen; |
409 | 3.69k | int r; |
410 | | |
411 | 3.69k | bio_reset_template(t); |
412 | | |
413 | 3.69k | e->remaining_samples = 0; |
414 | 3.69k | e->last_status = 0; |
415 | | |
416 | 3.69k | if ((msg = malloc(FIDO_MAXMSG)) == NULL) { |
417 | 46 | r = FIDO_ERR_INTERNAL; |
418 | 46 | goto out; |
419 | 46 | } |
420 | | |
421 | 3.65k | if ((msglen = fido_rx(dev, CTAP_CMD_CBOR, msg, FIDO_MAXMSG, ms)) < 0) { |
422 | 294 | fido_log_debug("%s: fido_rx", __func__); |
423 | 294 | r = FIDO_ERR_RX; |
424 | 294 | goto out; |
425 | 294 | } |
426 | | |
427 | 3.35k | if ((r = cbor_parse_reply(msg, (size_t)msglen, e, |
428 | 3.35k | bio_parse_enroll_status)) != FIDO_OK) { |
429 | 593 | fido_log_debug("%s: bio_parse_enroll_status", __func__); |
430 | 593 | goto out; |
431 | 593 | } |
432 | | |
433 | 2.76k | if ((r = cbor_parse_reply(msg, (size_t)msglen, &t->id, |
434 | 2.76k | bio_parse_template_id)) != FIDO_OK) { |
435 | 157 | fido_log_debug("%s: bio_parse_template_id", __func__); |
436 | 157 | goto out; |
437 | 157 | } |
438 | | |
439 | 2.60k | r = FIDO_OK; |
440 | 3.69k | out: |
441 | 3.69k | freezero(msg, FIDO_MAXMSG); |
442 | | |
443 | 3.69k | return (r); |
444 | 2.60k | } |
445 | | |
446 | | static int |
447 | | bio_enroll_begin_wait(fido_dev_t *dev, fido_bio_template_t *t, |
448 | | fido_bio_enroll_t *e, uint32_t timo_ms, int *ms) |
449 | 3.93k | { |
450 | 3.93k | cbor_item_t *argv[3]; |
451 | 3.93k | const uint8_t cmd = CMD_ENROLL_BEGIN; |
452 | 3.93k | int r = FIDO_ERR_INTERNAL; |
453 | | |
454 | 3.93k | memset(&argv, 0, sizeof(argv)); |
455 | | |
456 | 3.93k | if ((argv[2] = cbor_build_uint(timo_ms)) == NULL) { |
457 | 15 | fido_log_debug("%s: cbor encode", __func__); |
458 | 15 | goto fail; |
459 | 15 | } |
460 | | |
461 | 3.92k | if ((r = bio_tx(dev, cmd, argv, 3, NULL, e->token, ms)) != FIDO_OK || |
462 | 3.92k | (r = bio_rx_enroll_begin(dev, t, e, ms)) != FIDO_OK) { |
463 | 1.31k | fido_log_debug("%s: tx/rx", __func__); |
464 | 1.31k | goto fail; |
465 | 1.31k | } |
466 | | |
467 | 2.60k | r = FIDO_OK; |
468 | 3.93k | fail: |
469 | 3.93k | cbor_vector_free(argv, nitems(argv)); |
470 | | |
471 | 3.93k | return (r); |
472 | 2.60k | } |
473 | | |
474 | | int |
475 | | fido_bio_dev_enroll_begin(fido_dev_t *dev, fido_bio_template_t *t, |
476 | | fido_bio_enroll_t *e, uint32_t timo_ms, const char *pin) |
477 | 27.5k | { |
478 | 27.5k | es256_pk_t *pk = NULL; |
479 | 27.5k | fido_blob_t *ecdh = NULL; |
480 | 27.5k | fido_blob_t *token = NULL; |
481 | 27.5k | int ms = dev->timeout_ms; |
482 | 27.5k | int r; |
483 | | |
484 | 27.5k | if (pin == NULL || e->token != NULL) |
485 | 0 | return (FIDO_ERR_INVALID_ARGUMENT); |
486 | | |
487 | 27.5k | if ((token = fido_blob_new()) == NULL) { |
488 | 5 | r = FIDO_ERR_INTERNAL; |
489 | 5 | goto fail; |
490 | 5 | } |
491 | | |
492 | 27.5k | if ((r = fido_do_ecdh(dev, &pk, &ecdh, &ms)) != FIDO_OK) { |
493 | 20.0k | fido_log_debug("%s: fido_do_ecdh", __func__); |
494 | 20.0k | goto fail; |
495 | 20.0k | } |
496 | | |
497 | 7.58k | if ((r = fido_dev_get_uv_token(dev, CTAP_CBOR_BIO_ENROLL_PRE, pin, ecdh, |
498 | 7.58k | pk, NULL, token, &ms)) != FIDO_OK) { |
499 | 3.64k | fido_log_debug("%s: fido_dev_get_uv_token", __func__); |
500 | 3.64k | goto fail; |
501 | 3.64k | } |
502 | | |
503 | 3.93k | e->token = token; |
504 | 3.93k | token = NULL; |
505 | 27.5k | fail: |
506 | 27.5k | es256_pk_free(&pk); |
507 | 27.5k | fido_blob_free(&ecdh); |
508 | 27.5k | fido_blob_free(&token); |
509 | | |
510 | 27.5k | if (r != FIDO_OK) |
511 | 23.6k | return (r); |
512 | | |
513 | 3.93k | return (bio_enroll_begin_wait(dev, t, e, timo_ms, &ms)); |
514 | 27.5k | } |
515 | | |
516 | | static int |
517 | | bio_rx_enroll_continue(fido_dev_t *dev, fido_bio_enroll_t *e, int *ms) |
518 | 3.84k | { |
519 | 3.84k | unsigned char *msg; |
520 | 3.84k | int msglen; |
521 | 3.84k | int r; |
522 | | |
523 | 3.84k | e->remaining_samples = 0; |
524 | 3.84k | e->last_status = 0; |
525 | | |
526 | 3.84k | if ((msg = malloc(FIDO_MAXMSG)) == NULL) { |
527 | 64 | r = FIDO_ERR_INTERNAL; |
528 | 64 | goto out; |
529 | 64 | } |
530 | | |
531 | 3.78k | if ((msglen = fido_rx(dev, CTAP_CMD_CBOR, msg, FIDO_MAXMSG, ms)) < 0) { |
532 | 1.20k | fido_log_debug("%s: fido_rx", __func__); |
533 | 1.20k | r = FIDO_ERR_RX; |
534 | 1.20k | goto out; |
535 | 1.20k | } |
536 | | |
537 | 2.57k | if ((r = cbor_parse_reply(msg, (size_t)msglen, e, |
538 | 2.57k | bio_parse_enroll_status)) != FIDO_OK) { |
539 | 985 | fido_log_debug("%s: bio_parse_enroll_status", __func__); |
540 | 985 | goto out; |
541 | 985 | } |
542 | | |
543 | 1.58k | r = FIDO_OK; |
544 | 3.84k | out: |
545 | 3.84k | freezero(msg, FIDO_MAXMSG); |
546 | | |
547 | 3.84k | return (r); |
548 | 1.58k | } |
549 | | |
550 | | static int |
551 | | bio_enroll_continue_wait(fido_dev_t *dev, const fido_bio_template_t *t, |
552 | | fido_bio_enroll_t *e, uint32_t timo_ms, int *ms) |
553 | 8.19k | { |
554 | 8.19k | cbor_item_t *argv[3]; |
555 | 8.19k | const uint8_t cmd = CMD_ENROLL_NEXT; |
556 | 8.19k | int r = FIDO_ERR_INTERNAL; |
557 | | |
558 | 8.19k | memset(&argv, 0, sizeof(argv)); |
559 | | |
560 | 8.19k | if ((argv[0] = fido_blob_encode(&t->id)) == NULL || |
561 | 8.19k | (argv[2] = cbor_build_uint(timo_ms)) == NULL) { |
562 | 1.30k | fido_log_debug("%s: cbor encode", __func__); |
563 | 1.30k | goto fail; |
564 | 1.30k | } |
565 | | |
566 | 6.88k | if ((r = bio_tx(dev, cmd, argv, 3, NULL, e->token, ms)) != FIDO_OK || |
567 | 6.88k | (r = bio_rx_enroll_continue(dev, e, ms)) != FIDO_OK) { |
568 | 5.29k | fido_log_debug("%s: tx/rx", __func__); |
569 | 5.29k | goto fail; |
570 | 5.29k | } |
571 | | |
572 | 1.58k | r = FIDO_OK; |
573 | 8.19k | fail: |
574 | 8.19k | cbor_vector_free(argv, nitems(argv)); |
575 | | |
576 | 8.19k | return (r); |
577 | 1.58k | } |
578 | | |
579 | | int |
580 | | fido_bio_dev_enroll_continue(fido_dev_t *dev, const fido_bio_template_t *t, |
581 | | fido_bio_enroll_t *e, uint32_t timo_ms) |
582 | 8.19k | { |
583 | 8.19k | int ms = dev->timeout_ms; |
584 | | |
585 | 8.19k | if (e->token == NULL) |
586 | 0 | return (FIDO_ERR_INVALID_ARGUMENT); |
587 | | |
588 | 8.19k | return (bio_enroll_continue_wait(dev, t, e, timo_ms, &ms)); |
589 | 8.19k | } |
590 | | |
591 | | static int |
592 | | bio_enroll_cancel_wait(fido_dev_t *dev, int *ms) |
593 | 0 | { |
594 | 0 | const uint8_t cmd = CMD_ENROLL_CANCEL; |
595 | 0 | int r; |
596 | |
|
597 | 0 | if ((r = bio_tx(dev, cmd, NULL, 0, NULL, NULL, ms)) != FIDO_OK || |
598 | 0 | (r = fido_rx_cbor_status(dev, ms)) != FIDO_OK) { |
599 | 0 | fido_log_debug("%s: tx/rx", __func__); |
600 | 0 | return (r); |
601 | 0 | } |
602 | | |
603 | 0 | return (FIDO_OK); |
604 | 0 | } |
605 | | |
606 | | int |
607 | | fido_bio_dev_enroll_cancel(fido_dev_t *dev) |
608 | 0 | { |
609 | 0 | int ms = dev->timeout_ms; |
610 | |
|
611 | 0 | return (bio_enroll_cancel_wait(dev, &ms)); |
612 | 0 | } |
613 | | |
614 | | static int |
615 | | bio_enroll_remove_wait(fido_dev_t *dev, const fido_bio_template_t *t, |
616 | | const char *pin, int *ms) |
617 | 8.31k | { |
618 | 8.31k | cbor_item_t *argv[1]; |
619 | 8.31k | const uint8_t cmd = CMD_ENROLL_REMOVE; |
620 | 8.31k | int r = FIDO_ERR_INTERNAL; |
621 | | |
622 | 8.31k | memset(&argv, 0, sizeof(argv)); |
623 | | |
624 | 8.31k | if ((argv[0] = fido_blob_encode(&t->id)) == NULL) { |
625 | 209 | fido_log_debug("%s: cbor encode", __func__); |
626 | 209 | goto fail; |
627 | 209 | } |
628 | | |
629 | 8.10k | if ((r = bio_tx(dev, cmd, argv, 1, pin, NULL, ms)) != FIDO_OK || |
630 | 8.10k | (r = fido_rx_cbor_status(dev, ms)) != FIDO_OK) { |
631 | 7.99k | fido_log_debug("%s: tx/rx", __func__); |
632 | 7.99k | goto fail; |
633 | 7.99k | } |
634 | | |
635 | 106 | r = FIDO_OK; |
636 | 8.31k | fail: |
637 | 8.31k | cbor_vector_free(argv, nitems(argv)); |
638 | | |
639 | 8.31k | return (r); |
640 | 106 | } |
641 | | |
642 | | int |
643 | | fido_bio_dev_enroll_remove(fido_dev_t *dev, const fido_bio_template_t *t, |
644 | | const char *pin) |
645 | 8.31k | { |
646 | 8.31k | int ms = dev->timeout_ms; |
647 | | |
648 | 8.31k | return (bio_enroll_remove_wait(dev, t, pin, &ms)); |
649 | 8.31k | } |
650 | | |
651 | | static void |
652 | | bio_reset_info(fido_bio_info_t *i) |
653 | 20.9k | { |
654 | 20.9k | i->type = 0; |
655 | 20.9k | i->max_samples = 0; |
656 | 20.9k | } |
657 | | |
658 | | static int |
659 | | bio_parse_info(const cbor_item_t *key, const cbor_item_t *val, void *arg) |
660 | 8.63k | { |
661 | 8.63k | fido_bio_info_t *i = arg; |
662 | 8.63k | uint64_t x; |
663 | | |
664 | 8.63k | if (cbor_isa_uint(key) == false || |
665 | 8.63k | cbor_int_get_width(key) != CBOR_INT_8) { |
666 | 6.19k | fido_log_debug("%s: cbor type", __func__); |
667 | 6.19k | return (0); /* ignore */ |
668 | 6.19k | } |
669 | | |
670 | 2.43k | switch (cbor_get_uint8(key)) { |
671 | 222 | case 2: |
672 | 222 | if (cbor_decode_uint64(val, &x) < 0 || x > UINT8_MAX) { |
673 | 109 | fido_log_debug("%s: cbor_decode_uint64", __func__); |
674 | 109 | return (-1); |
675 | 109 | } |
676 | 113 | i->type = (uint8_t)x; |
677 | 113 | break; |
678 | 200 | case 3: |
679 | 200 | if (cbor_decode_uint64(val, &x) < 0 || x > UINT8_MAX) { |
680 | 122 | fido_log_debug("%s: cbor_decode_uint64", __func__); |
681 | 122 | return (-1); |
682 | 122 | } |
683 | 78 | i->max_samples = (uint8_t)x; |
684 | 78 | break; |
685 | 2.01k | default: |
686 | 2.01k | return (0); /* ignore */ |
687 | 2.43k | } |
688 | | |
689 | 191 | return (0); |
690 | 2.43k | } |
691 | | |
692 | | static int |
693 | | bio_rx_info(fido_dev_t *dev, fido_bio_info_t *i, int *ms) |
694 | 20.9k | { |
695 | 20.9k | unsigned char *msg; |
696 | 20.9k | int msglen; |
697 | 20.9k | int r; |
698 | | |
699 | 20.9k | bio_reset_info(i); |
700 | | |
701 | 20.9k | if ((msg = malloc(FIDO_MAXMSG)) == NULL) { |
702 | 63 | r = FIDO_ERR_INTERNAL; |
703 | 63 | goto out; |
704 | 63 | } |
705 | | |
706 | 20.8k | if ((msglen = fido_rx(dev, CTAP_CMD_CBOR, msg, FIDO_MAXMSG, ms)) < 0) { |
707 | 15.4k | fido_log_debug("%s: fido_rx", __func__); |
708 | 15.4k | r = FIDO_ERR_RX; |
709 | 15.4k | goto out; |
710 | 15.4k | } |
711 | | |
712 | 5.45k | if ((r = cbor_parse_reply(msg, (size_t)msglen, i, |
713 | 5.45k | bio_parse_info)) != FIDO_OK) { |
714 | 5.26k | fido_log_debug("%s: bio_parse_info" , __func__); |
715 | 5.26k | goto out; |
716 | 5.26k | } |
717 | | |
718 | 193 | r = FIDO_OK; |
719 | 20.9k | out: |
720 | 20.9k | freezero(msg, FIDO_MAXMSG); |
721 | | |
722 | 20.9k | return (r); |
723 | 193 | } |
724 | | |
725 | | static int |
726 | | bio_get_info_wait(fido_dev_t *dev, fido_bio_info_t *i, int *ms) |
727 | 21.9k | { |
728 | 21.9k | int r; |
729 | | |
730 | 21.9k | if ((r = bio_tx(dev, CMD_GET_INFO, NULL, 0, NULL, NULL, |
731 | 21.9k | ms)) != FIDO_OK || |
732 | 21.9k | (r = bio_rx_info(dev, i, ms)) != FIDO_OK) { |
733 | 21.7k | fido_log_debug("%s: tx/rx", __func__); |
734 | 21.7k | return (r); |
735 | 21.7k | } |
736 | | |
737 | 193 | return (FIDO_OK); |
738 | 21.9k | } |
739 | | |
740 | | int |
741 | | fido_bio_dev_get_info(fido_dev_t *dev, fido_bio_info_t *i) |
742 | 21.9k | { |
743 | 21.9k | int ms = dev->timeout_ms; |
744 | | |
745 | 21.9k | return (bio_get_info_wait(dev, i, &ms)); |
746 | 21.9k | } |
747 | | |
748 | | const char * |
749 | | fido_bio_template_name(const fido_bio_template_t *t) |
750 | 63.9k | { |
751 | 63.9k | return (t->name); |
752 | 63.9k | } |
753 | | |
754 | | const unsigned char * |
755 | | fido_bio_template_id_ptr(const fido_bio_template_t *t) |
756 | 63.9k | { |
757 | 63.9k | return (t->id.ptr); |
758 | 63.9k | } |
759 | | |
760 | | size_t |
761 | | fido_bio_template_id_len(const fido_bio_template_t *t) |
762 | 63.9k | { |
763 | 63.9k | return (t->id.len); |
764 | 63.9k | } |
765 | | |
766 | | size_t |
767 | | fido_bio_template_array_count(const fido_bio_template_array_t *ta) |
768 | 37.0k | { |
769 | 37.0k | return (ta->n_rx); |
770 | 37.0k | } |
771 | | |
772 | | fido_bio_template_array_t * |
773 | | fido_bio_template_array_new(void) |
774 | 14.7k | { |
775 | 14.7k | return (calloc(1, sizeof(fido_bio_template_array_t))); |
776 | 14.7k | } |
777 | | |
778 | | fido_bio_template_t * |
779 | | fido_bio_template_new(void) |
780 | 47.7k | { |
781 | 47.7k | return (calloc(1, sizeof(fido_bio_template_t))); |
782 | 47.7k | } |
783 | | |
784 | | void |
785 | | fido_bio_template_array_free(fido_bio_template_array_t **tap) |
786 | 54.8k | { |
787 | 54.8k | fido_bio_template_array_t *ta; |
788 | | |
789 | 54.8k | if (tap == NULL || (ta = *tap) == NULL) |
790 | 40.2k | return; |
791 | | |
792 | 14.6k | bio_reset_template_array(ta); |
793 | 14.6k | free(ta); |
794 | 14.6k | *tap = NULL; |
795 | 14.6k | } |
796 | | |
797 | | void |
798 | | fido_bio_template_free(fido_bio_template_t **tp) |
799 | 164k | { |
800 | 164k | fido_bio_template_t *t; |
801 | | |
802 | 164k | if (tp == NULL || (t = *tp) == NULL) |
803 | 117k | return; |
804 | | |
805 | 47.6k | bio_reset_template(t); |
806 | 47.6k | free(t); |
807 | 47.6k | *tp = NULL; |
808 | 47.6k | } |
809 | | |
810 | | int |
811 | | fido_bio_template_set_name(fido_bio_template_t *t, const char *name) |
812 | 11.6k | { |
813 | 11.6k | free(t->name); |
814 | 11.6k | t->name = NULL; |
815 | | |
816 | 11.6k | if (name && (t->name = strdup(name)) == NULL) |
817 | 62 | return (FIDO_ERR_INTERNAL); |
818 | | |
819 | 11.6k | return (FIDO_OK); |
820 | 11.6k | } |
821 | | |
822 | | int |
823 | | fido_bio_template_set_id(fido_bio_template_t *t, const unsigned char *ptr, |
824 | | size_t len) |
825 | 19.9k | { |
826 | 19.9k | fido_blob_reset(&t->id); |
827 | | |
828 | 19.9k | if (ptr && fido_blob_set(&t->id, ptr, len) < 0) |
829 | 288 | return (FIDO_ERR_INTERNAL); |
830 | | |
831 | 19.6k | return (FIDO_OK); |
832 | 19.9k | } |
833 | | |
834 | | const fido_bio_template_t * |
835 | | fido_bio_template(const fido_bio_template_array_t *ta, size_t idx) |
836 | 22.3k | { |
837 | 22.3k | if (idx >= ta->n_alloc) |
838 | 14.2k | return (NULL); |
839 | | |
840 | 8.15k | return (&ta->ptr[idx]); |
841 | 22.3k | } |
842 | | |
843 | | fido_bio_enroll_t * |
844 | | fido_bio_enroll_new(void) |
845 | 27.6k | { |
846 | 27.6k | return (calloc(1, sizeof(fido_bio_enroll_t))); |
847 | 27.6k | } |
848 | | |
849 | | fido_bio_info_t * |
850 | | fido_bio_info_new(void) |
851 | 22.0k | { |
852 | 22.0k | return (calloc(1, sizeof(fido_bio_info_t))); |
853 | 22.0k | } |
854 | | |
855 | | uint8_t |
856 | | fido_bio_info_type(const fido_bio_info_t *i) |
857 | 21.9k | { |
858 | 21.9k | return (i->type); |
859 | 21.9k | } |
860 | | |
861 | | uint8_t |
862 | | fido_bio_info_max_samples(const fido_bio_info_t *i) |
863 | 21.9k | { |
864 | 21.9k | return (i->max_samples); |
865 | 21.9k | } |
866 | | |
867 | | void |
868 | | fido_bio_enroll_free(fido_bio_enroll_t **ep) |
869 | 54.8k | { |
870 | 54.8k | fido_bio_enroll_t *e; |
871 | | |
872 | 54.8k | if (ep == NULL || (e = *ep) == NULL) |
873 | 27.3k | return; |
874 | | |
875 | 27.5k | bio_reset_enroll(e); |
876 | | |
877 | 27.5k | free(e); |
878 | 27.5k | *ep = NULL; |
879 | 27.5k | } |
880 | | |
881 | | void |
882 | | fido_bio_info_free(fido_bio_info_t **ip) |
883 | 54.8k | { |
884 | 54.8k | fido_bio_info_t *i; |
885 | | |
886 | 54.8k | if (ip == NULL || (i = *ip) == NULL) |
887 | 32.9k | return; |
888 | | |
889 | 21.9k | free(i); |
890 | 21.9k | *ip = NULL; |
891 | 21.9k | } |
892 | | |
893 | | uint8_t |
894 | | fido_bio_enroll_remaining_samples(const fido_bio_enroll_t *e) |
895 | 71.5k | { |
896 | 71.5k | return (e->remaining_samples); |
897 | 71.5k | } |
898 | | |
899 | | uint8_t |
900 | | fido_bio_enroll_last_status(const fido_bio_enroll_t *e) |
901 | 35.7k | { |
902 | 35.7k | return (e->last_status); |
903 | 35.7k | } |