Ashin Walpola
0e9525162d
obu-firmware builds against vanetza-idf from microbu-esp32c5/external, but that tree was gitignored, so a clone of this repository could not build the firmware it ships. It is now committed here as ordinary files in its own folder, microbu-esp32c5/: the colleague's commit cf4b99f plus the V2X2MAP bridge's signature verification (--trust) used on the bench. Nothing is fetched from or pushed to the colleague's repository; this repository and its remotes carry everything. The folder's own .gitignore keeps build output, downloaded components and private key material out, as it did there; the committed file set is identical to that repository's tracked files. The ESP32-C5 is still flashed from obu-firmware/, which only takes vanetza-idf from microbu-esp32c5/, so the two stay separate folders. FLASHING.md says how to take a newer version of the colleague's tree (copy it over the folder, rebuild, test, commit).
101 lines
2.8 KiB
C
101 lines
2.8 KiB
C
#include "asn_application.h"
|
|
#include "asn_internal.h"
|
|
#include "aper_decoder.h"
|
|
|
|
asn_dec_rval_t
|
|
aper_decode_complete(const asn_codec_ctx_t *opt_codec_ctx,
|
|
const asn_TYPE_descriptor_t *td, void **sptr,
|
|
const void *buffer, size_t size) {
|
|
asn_dec_rval_t rval;
|
|
|
|
rval = aper_decode(opt_codec_ctx, td, sptr, buffer, size, 0, 0);
|
|
if(rval.consumed) {
|
|
/*
|
|
* We've always given 8-aligned data,
|
|
* so convert bits to integral bytes.
|
|
*/
|
|
rval.consumed += 7;
|
|
rval.consumed >>= 3;
|
|
} else if(rval.code == RC_OK) {
|
|
if(size) {
|
|
if(((const uint8_t *)buffer)[0] == 0) {
|
|
rval.consumed = 1; /* 1 byte */
|
|
} else {
|
|
ASN_DEBUG("Expecting single zeroed byte");
|
|
rval.code = RC_FAIL;
|
|
}
|
|
} else {
|
|
/* Must contain at least 8 bits. */
|
|
rval.code = RC_WMORE;
|
|
}
|
|
}
|
|
|
|
return rval;
|
|
}
|
|
|
|
asn_dec_rval_t
|
|
aper_decode(const asn_codec_ctx_t *opt_codec_ctx,
|
|
const asn_TYPE_descriptor_t *td, void **sptr, const void *buffer,
|
|
size_t size, int skip_bits, int unused_bits) {
|
|
asn_codec_ctx_t s_codec_ctx;
|
|
asn_dec_rval_t rval;
|
|
asn_per_data_t pd;
|
|
|
|
if(skip_bits < 0 || skip_bits > 7
|
|
|| unused_bits < 0 || unused_bits > 7
|
|
|| (unused_bits > 0 && !size))
|
|
ASN__DECODE_FAILED;
|
|
|
|
/*
|
|
* Stack checker requires that the codec context
|
|
* must be allocated on the stack.
|
|
*/
|
|
if(opt_codec_ctx) {
|
|
if(opt_codec_ctx->max_stack_size) {
|
|
s_codec_ctx = *opt_codec_ctx;
|
|
opt_codec_ctx = &s_codec_ctx;
|
|
}
|
|
} else {
|
|
/* If context is not given, be security-conscious anyway */
|
|
memset(&s_codec_ctx, 0, sizeof(s_codec_ctx));
|
|
s_codec_ctx.max_stack_size = ASN__DEFAULT_STACK_MAX;
|
|
opt_codec_ctx = &s_codec_ctx;
|
|
}
|
|
|
|
/* Fill in the position indicator */
|
|
memset(&pd, 0, sizeof(pd));
|
|
pd.buffer = (const uint8_t *)buffer;
|
|
pd.nboff = skip_bits;
|
|
pd.nbits = 8 * size - unused_bits; /* 8 is CHAR_BIT from <limits.h> */
|
|
if(pd.nboff > pd.nbits)
|
|
ASN__DECODE_FAILED;
|
|
|
|
/*
|
|
* Invoke type-specific decoder.
|
|
*/
|
|
if(!td->op->aper_decoder)
|
|
ASN__DECODE_FAILED; /* PER is not compiled in */
|
|
rval = td->op->aper_decoder(opt_codec_ctx, td, 0, sptr, &pd);
|
|
if(rval.code == RC_OK) {
|
|
/* Return the number of consumed bits */
|
|
rval.consumed = ((pd.buffer - (const uint8_t *)buffer) << 3)
|
|
+ pd.nboff - skip_bits;
|
|
ASN_DEBUG("PER decoding consumed %zu, counted %zu",
|
|
rval.consumed, pd.moved);
|
|
assert(rval.consumed == pd.moved);
|
|
} else {
|
|
/* Calculate actual consumed bits even for non-OK results */
|
|
rval.consumed = ((pd.buffer - (const uint8_t *)buffer) << 3)
|
|
+ pd.nboff - skip_bits;
|
|
/* For RC_WMORE, report actual consumption to avoid infinite loops */
|
|
if(rval.code == RC_WMORE && rval.consumed == 0 && pd.moved > 0) {
|
|
rval.consumed = pd.moved;
|
|
}
|
|
/* PER codec is not a restartable for RC_FAIL */
|
|
if(rval.code == RC_FAIL) {
|
|
rval.consumed = 0;
|
|
}
|
|
}
|
|
return rval;
|
|
}
|