webadmin/pico-keys-sdk
1
0
Fork 0
mirror of https://github.com/polhenarejos/pico-keys-sdk synced 2026-05-08 22:16:10 +02:00
Code Issues Packages Projects Releases Wiki Activity

Harmonizing coding style.

Browse Source 
Signed-off-by: Pol Henarejos <pol.henarejos@cttc.es>
This commit is contained in:
Pol Henarejos
2023-02-14 23:11:51 +01:00
parent 31e66007d3
commit 12bdcbd1f9
30 changed files with 1475 additions and 1036 deletions
Download Patch File Download Diff File Expand all files Collapse all files

62
src/asn1.c
View File

@@ -17,27 +17,29 @@
#include "asn1.h"
size_t asn1_len_tag(uint16_t tag, size_t len) {
size_t asn1_len_tag(uint16_t tag, size_t len)
{
size_t ret = 1+format_tlv_len(len, NULL)+len;
if (tag > 0x00ff)
if (tag > 0x00ff) {
return ret+1;
}
return ret;
}
int format_tlv_len(size_t len, uint8_t *out) {
int format_tlv_len(size_t len, uint8_t *out)
{
if (len < 128) {
if (out)
if (out) {
*out = len;
}
return 1;
}
else if (len < 256) {
} else if (len < 256) {
if (out) {
*out++ = 0x81;
*out++ = len;
}
return 2;
}
else {
} else {
if (out) {
*out++ = 0x82;
*out++ = (len >> 8) & 0xff;
@@ -48,13 +50,22 @@ int format_tlv_len(size_t len, uint8_t *out) {
return 0;
}
int walk_tlv(const uint8_t *cdata, size_t cdata_len, uint8_t **p, uint16_t *tag, size_t *tag_len, uint8_t **data) {
if (!p)
int walk_tlv(const uint8_t *cdata,
size_t cdata_len,
uint8_t **p,
uint16_t *tag,
size_t *tag_len,
uint8_t **data)
{
if (!p) {
return 0;
if (!*p)
*p = (uint8_t *)cdata;
if (*p-cdata >= cdata_len)
}
if (!*p) {
*p = (uint8_t *) cdata;
}
if (*p-cdata >= cdata_len) {
return 0;
}
uint16_t tg = 0x0;
size_t tgl = 0;
tg = *(*p)++;
@@ -66,31 +77,40 @@ int walk_tlv(const uint8_t *cdata, size_t cdata_len, uint8_t **p, uint16_t *tag,
if (tgl == 0x82) {
tgl = *(*p)++ << 8;
tgl |= *(*p)++;
}
else if (tgl == 0x81) {
} else if (tgl == 0x81) {
tgl = *(*p)++;
}
if (tag)
if (tag) {
*tag = tg;
if (tag_len)
}
if (tag_len) {
*tag_len = tgl;
if (data)
}
if (data) {
*data = *p;
}
*p = *p+tgl;
return 1;
}
bool asn1_find_tag(const uint8_t *data, size_t data_len, uint16_t itag, size_t *tag_len, uint8_t **tag_data) {
bool asn1_find_tag(const uint8_t *data,
size_t data_len,
uint16_t itag,
size_t *tag_len,
uint8_t **tag_data)
{
uint16_t tag = 0x0;
uint8_t *p = NULL;
uint8_t *tdata = NULL;
size_t tlen = 0;
while (walk_tlv(data, data_len, &p, &tag, &tlen, &tdata)) {
if (itag == tag) {
if (tag_data != NULL)
if (tag_data != NULL) {
*tag_data = tdata;
if (tag_len != NULL)
}
if (tag_len != NULL) {
*tag_len = tlen;
}
return true;
}
}