mirror of
https://github.com/polhenarejos/pico-keys-sdk
synced 2026-05-11 09:48:24 +02:00
Added support for building emulation in Windows.
It has not been tested but it should not break any linux build. Signed-off-by: Pol Henarejos <pol.henarejos@cttc.es>
This commit is contained in:
35
src/asn1.c
35
src/asn1.c
@@ -17,44 +17,41 @@
|
||||
|
||||
#include "asn1.h"
|
||||
|
||||
size_t asn1_len_tag(uint16_t tag, size_t len) {
|
||||
size_t ret = 1 + format_tlv_len(len, NULL) + len;
|
||||
uint16_t asn1_len_tag(uint16_t tag, uint16_t len) {
|
||||
uint16_t ret = 1 + format_tlv_len(len, NULL) + len;
|
||||
if (tag > 0x00ff) {
|
||||
return ret + 1;
|
||||
}
|
||||
return ret;
|
||||
}
|
||||
|
||||
int format_tlv_len(size_t len, uint8_t *out) {
|
||||
uint8_t format_tlv_len(uint16_t len, uint8_t *out) {
|
||||
if (len < 128) {
|
||||
if (out) {
|
||||
*out = len;
|
||||
*out = (uint8_t)len;
|
||||
}
|
||||
return 1;
|
||||
}
|
||||
else if (len < 256) {
|
||||
if (out) {
|
||||
*out++ = 0x81;
|
||||
*out++ = len;
|
||||
*out++ = (uint8_t)len;
|
||||
}
|
||||
return 2;
|
||||
}
|
||||
else {
|
||||
if (out) {
|
||||
*out++ = 0x82;
|
||||
*out++ = (len >> 8) & 0xff;
|
||||
*out++ = len & 0xff;
|
||||
}
|
||||
return 3;
|
||||
if (out) {
|
||||
*out++ = 0x82;
|
||||
*out++ = (len >> 8) & 0xff;
|
||||
*out++ = len & 0xff;
|
||||
}
|
||||
return 0;
|
||||
return 3;
|
||||
}
|
||||
|
||||
int walk_tlv(const uint8_t *cdata,
|
||||
size_t cdata_len,
|
||||
uint16_t cdata_len,
|
||||
uint8_t **p,
|
||||
uint16_t *tag,
|
||||
size_t *tag_len,
|
||||
uint16_t *tag_len,
|
||||
uint8_t **data) {
|
||||
if (!p) {
|
||||
return 0;
|
||||
@@ -66,7 +63,7 @@ int walk_tlv(const uint8_t *cdata,
|
||||
return 0;
|
||||
}
|
||||
uint16_t tg = 0x0;
|
||||
size_t tgl = 0;
|
||||
uint16_t tgl = 0;
|
||||
tg = *(*p)++;
|
||||
if ((tg & 0x1f) == 0x1f) {
|
||||
tg <<= 8;
|
||||
@@ -94,14 +91,14 @@ int walk_tlv(const uint8_t *cdata,
|
||||
}
|
||||
|
||||
bool asn1_find_tag(const uint8_t *data,
|
||||
size_t data_len,
|
||||
uint16_t data_len,
|
||||
uint16_t itag,
|
||||
size_t *tag_len,
|
||||
uint16_t *tag_len,
|
||||
uint8_t **tag_data) {
|
||||
uint16_t tag = 0x0;
|
||||
uint8_t *p = NULL;
|
||||
uint8_t *tdata = NULL;
|
||||
size_t tlen = 0;
|
||||
uint16_t tlen = 0;
|
||||
while (walk_tlv(data, data_len, &p, &tag, &tlen, &tdata)) {
|
||||
if (itag == tag) {
|
||||
if (tag_data != NULL) {
|
||||
|
||||
Reference in New Issue
Block a user