mirror of
https://github.com/token2/fido2-manage.git
synced 2026-04-09 18:55:38 +00:00
66 lines
1.5 KiB
C
66 lines
1.5 KiB
C
/*
|
|
* Copyright (c) 2018 Yubico AB. All rights reserved.
|
|
* Use of this source code is governed by a BSD-style
|
|
* license that can be found in the LICENSE file.
|
|
* SPDX-License-Identifier: BSD-2-Clause
|
|
*/
|
|
|
|
#include "fido.h"
|
|
|
|
iso7816_apdu_t *
|
|
iso7816_new(uint8_t cla, uint8_t ins, uint8_t p1, uint16_t payload_len)
|
|
{
|
|
iso7816_apdu_t *apdu;
|
|
size_t alloc_len;
|
|
|
|
alloc_len = sizeof(iso7816_apdu_t) + payload_len + 2; /* le1 le2 */
|
|
if ((apdu = calloc(1, alloc_len)) == NULL)
|
|
return NULL;
|
|
apdu->alloc_len = alloc_len;
|
|
apdu->payload_len = payload_len;
|
|
apdu->payload_ptr = apdu->payload;
|
|
apdu->header.cla = cla;
|
|
apdu->header.ins = ins;
|
|
apdu->header.p1 = p1;
|
|
apdu->header.lc2 = (uint8_t)((payload_len >> 8) & 0xff);
|
|
apdu->header.lc3 = (uint8_t)(payload_len & 0xff);
|
|
|
|
return apdu;
|
|
}
|
|
|
|
void
|
|
iso7816_free(iso7816_apdu_t **apdu_p)
|
|
{
|
|
iso7816_apdu_t *apdu;
|
|
|
|
if (apdu_p == NULL || (apdu = *apdu_p) == NULL)
|
|
return;
|
|
freezero(apdu, apdu->alloc_len);
|
|
*apdu_p = NULL;
|
|
}
|
|
|
|
int
|
|
iso7816_add(iso7816_apdu_t *apdu, const void *buf, size_t cnt)
|
|
{
|
|
if (cnt > apdu->payload_len || cnt > UINT16_MAX)
|
|
return -1;
|
|
memcpy(apdu->payload_ptr, buf, cnt);
|
|
apdu->payload_ptr += cnt;
|
|
apdu->payload_len = (uint16_t)(apdu->payload_len - cnt);
|
|
|
|
return 0;
|
|
}
|
|
|
|
const unsigned char *
|
|
iso7816_ptr(const iso7816_apdu_t *apdu)
|
|
{
|
|
return (const unsigned char *)&apdu->header;
|
|
}
|
|
|
|
size_t
|
|
iso7816_len(const iso7816_apdu_t *apdu)
|
|
{
|
|
return apdu->alloc_len - offsetof(iso7816_apdu_t, header) -
|
|
(sizeof(iso7816_apdu_t) - offsetof(iso7816_apdu_t, payload));
|
|
}
|