summaryrefslogtreecommitdiffstats
path: root/src/asn1helpers.c
diff options
context:
space:
mode:
Diffstat (limited to 'src/asn1helpers.c')
-rw-r--r--src/asn1helpers.c151
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;
+}