diff options
Diffstat (limited to 'src/asn1helpers.c')
| -rw-r--r-- | src/asn1helpers.c | 151 |
1 files changed, 151 insertions, 0 deletions
diff --git a/src/asn1helpers.c b/src/asn1helpers.c new file mode 100644 index 0000000..25f4af4 --- /dev/null +++ b/src/asn1helpers.c @@ -0,0 +1,151 @@ +/* helper functions to dela with asn1c data types */ + +/* (C) 2014-2015 by Harald Welte <laforge@gnumonks.org> + * All Rights Reserved + * + * This program is free software; you can redistribute it and/or modify + * it under the terms of the GNU Affero General Public License as published by + * the Free Software Foundation; either version 3 of the License, or + * (at your option) any later version. + * + * This program is distributed in the hope that it will be useful, + * but WITHOUT ANY WARRANTY; without even the implied warranty of + * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the + * GNU Affero General Public License for more details. + * + * You should have received a copy of the GNU Affero General Public License + * along with this program. If not, see <http://www.gnu.org/licenses/>. + * + */ + +#include <string.h> +#include <errno.h> +#include <arpa/inet.h> + +#include <osmocom/core/utils.h> + +#include "asn1helpers.h" +#include "asn_internal.h" + +void asn1_u32_to_bitstring(BIT_STRING_t *bitstr, uint32_t *buf, uint32_t in) +{ + *buf = htonl(in); + bitstr->buf = (uint8_t *) buf; + bitstr->size = sizeof(uint32_t); + bitstr->bits_unused = 0; +} + +void asn1_u28_to_bitstring(BIT_STRING_t *bitstr, uint32_t *buf, uint32_t in) +{ + *buf = htonl(in<<4); + bitstr->buf = (uint8_t *) buf; + bitstr->size = sizeof(uint32_t); + bitstr->bits_unused = 4; +} + +void asn1_u24_to_bitstring(BIT_STRING_t *bitstr, uint32_t *buf, uint32_t in) +{ + *buf = htonl(in<<8); + bitstr->buf = (uint8_t *) buf; + bitstr->size = 24/8; + bitstr->bits_unused = 0; +} + +int BIT_STRING_fromBuf(BIT_STRING_t *st, const uint8_t *str, unsigned int bit_len) +{ + void *buf; + unsigned int len = bit_len / 8; + + if (bit_len % 8) + len++; + + if (!st || (!str && len)) { + errno = EINVAL; + return -1; + } + + if (!str) { + FREEMEM(st->buf); + st->buf = 0; + st->size = 0; + st->bits_unused = 0; + return 0; + } + + if (len < 0) + len = strlen(str); + + buf = MALLOC(len); + if (!buf) { + errno = ENOMEM; + return -1; + } + + memcpy(buf, str, len); + FREEMEM(st->buf); + st->buf = buf; + st->size = len; + st->bits_unused = (len * 8) - bit_len; + + return 0; +} + +void asn1_u16_to_str(OCTET_STRING_t *str, uint16_t *buf, uint16_t in) +{ + *buf = htons(in); + str->buf = (uint8_t *) buf; + str->size = sizeof(uint16_t); +} + +void asn1_u8_to_str(OCTET_STRING_t *str, uint8_t *buf, uint8_t in) +{ + *buf = in; + str->buf = buf; + str->size = sizeof(uint8_t); +} + +int asn1_strncpy(char *out, const OCTET_STRING_t *in, size_t n) +{ + size_t cpylen = n-1; + + if (in->size < cpylen) + cpylen = in->size; + + strncpy(out, (char *)in->buf, cpylen); + out[cpylen] = '\0'; + + return cpylen; +} + +uint16_t asn1str_to_u16(const OCTET_STRING_t *in) +{ + OSMO_ASSERT(in && in->size == sizeof(uint16_t)); + return ntohs(*(uint16_t *)in->buf); +} + +uint8_t asn1str_to_u8(const OCTET_STRING_t *in) +{ + OSMO_ASSERT(in && in->size == sizeof(uint8_t)); + return *(uint8_t *)in->buf; +} + +uint32_t asn1bitstr_to_u32(const BIT_STRING_t *in) +{ + OSMO_ASSERT(in && in->size == sizeof(uint32_t)); + + return ntohl(*(uint32_t *)in->buf); +} + +uint32_t asn1bitstr_to_u28(const BIT_STRING_t *in) +{ + OSMO_ASSERT(in && in->size == sizeof(uint32_t) && in->bits_unused == 4); + + return ntohl(*(uint32_t *)in->buf) >> 4; +} + +uint32_t asn1bitstr_to_u24(const BIT_STRING_t *in) +{ + OSMO_ASSERT(in && in->size == 3); + + return ntohl(*(uint32_t *)in->buf) >> 8; +} |