mirror of https://gerrit.osmocom.org/asn1c
191 lines
4.8 KiB
C
191 lines
4.8 KiB
C
/*-
|
|
* Copyright (c) 2003, 2004 Lev Walkin <vlm@lionet.info>. All rights reserved.
|
|
* Redistribution and modifications are permitted subject to BSD license.
|
|
*/
|
|
#include <asn_internal.h>
|
|
#include <UniversalString.h>
|
|
#include <UTF8String.h>
|
|
|
|
/*
|
|
* UniversalString basic type description.
|
|
*/
|
|
static ber_tlv_tag_t asn_DEF_UniversalString_tags[] = {
|
|
(ASN_TAG_CLASS_UNIVERSAL | (28 << 2)), /* [UNIVERSAL 28] IMPLICIT ...*/
|
|
(ASN_TAG_CLASS_UNIVERSAL | (4 << 2)) /* ... OCTET STRING */
|
|
};
|
|
asn_TYPE_descriptor_t asn_DEF_UniversalString = {
|
|
"UniversalString",
|
|
"UniversalString",
|
|
OCTET_STRING_free,
|
|
UniversalString_print, /* Convert into UTF8 and print */
|
|
asn_generic_no_constraint,
|
|
OCTET_STRING_decode_ber,
|
|
OCTET_STRING_encode_der,
|
|
UniversalString_decode_xer, /* Convert from UTF-8 */
|
|
UniversalString_encode_xer, /* Convert into UTF-8 */
|
|
0, 0,
|
|
0, /* Use generic outmost tag fetcher */
|
|
asn_DEF_UniversalString_tags,
|
|
sizeof(asn_DEF_UniversalString_tags)
|
|
/ sizeof(asn_DEF_UniversalString_tags[0]) - 1,
|
|
asn_DEF_UniversalString_tags,
|
|
sizeof(asn_DEF_UniversalString_tags)
|
|
/ sizeof(asn_DEF_UniversalString_tags[0]),
|
|
0, /* No PER visible constraints */
|
|
0, 0, /* No members */
|
|
0 /* No specifics */
|
|
};
|
|
|
|
|
|
static ssize_t
|
|
UniversalString__dump(const UniversalString_t *st,
|
|
asn_app_consume_bytes_f *cb, void *app_key) {
|
|
char scratch[128]; /* Scratchpad buffer */
|
|
char *p = scratch;
|
|
ssize_t wrote = 0;
|
|
uint8_t *ch;
|
|
uint8_t *end;
|
|
|
|
ch = st->buf;
|
|
end = (st->buf + st->size);
|
|
for(end -= 3; ch < end; ch += 4) {
|
|
uint32_t wc = (ch[0] << 24)
|
|
| (ch[1] << 16)
|
|
| (ch[2] << 8)
|
|
| ch[3]; /* 4 bytes */
|
|
if(sizeof(scratch) - (p - scratch) < 6) {
|
|
wrote += p - scratch;
|
|
if(cb(scratch, p - scratch, app_key) < 0)
|
|
return -1;
|
|
p = scratch;
|
|
}
|
|
if(wc < 0x80) {
|
|
*p++ = (char)wc;
|
|
} else if(wc < 0x800) {
|
|
*p++ = 0xc0 | ((wc >> 6));
|
|
*p++ = 0x80 | ((wc & 0x3f));
|
|
} else if(wc < 0x10000) {
|
|
*p++ = 0xe0 | ((wc >> 12));
|
|
*p++ = 0x80 | ((wc >> 6) & 0x3f);
|
|
*p++ = 0x80 | ((wc & 0x3f));
|
|
} else if(wc < 0x200000) {
|
|
*p++ = 0xf0 | ((wc >> 18));
|
|
*p++ = 0x80 | ((wc >> 12) & 0x3f);
|
|
*p++ = 0x80 | ((wc >> 6) & 0x3f);
|
|
*p++ = 0x80 | ((wc & 0x3f));
|
|
} else if(wc < 0x4000000) {
|
|
*p++ = 0xf8 | ((wc >> 24));
|
|
*p++ = 0x80 | ((wc >> 18) & 0x3f);
|
|
*p++ = 0x80 | ((wc >> 12) & 0x3f);
|
|
*p++ = 0x80 | ((wc >> 6) & 0x3f);
|
|
*p++ = 0x80 | ((wc & 0x3f));
|
|
} else {
|
|
*p++ = 0xfc | ((wc >> 30) & 0x1);
|
|
*p++ = 0x80 | ((wc >> 24) & 0x3f);
|
|
*p++ = 0x80 | ((wc >> 18) & 0x3f);
|
|
*p++ = 0x80 | ((wc >> 12) & 0x3f);
|
|
*p++ = 0x80 | ((wc >> 6) & 0x3f);
|
|
*p++ = 0x80 | ((wc & 0x3f));
|
|
}
|
|
}
|
|
|
|
wrote += p - scratch;
|
|
if(cb(scratch, p - scratch, app_key) < 0)
|
|
return -1;
|
|
|
|
return wrote;
|
|
}
|
|
|
|
asn_dec_rval_t
|
|
UniversalString_decode_xer(asn_codec_ctx_t *opt_codec_ctx,
|
|
asn_TYPE_descriptor_t *td, void **sptr,
|
|
const char *opt_mname, const void *buf_ptr, size_t size) {
|
|
asn_dec_rval_t rc;
|
|
|
|
rc = OCTET_STRING_decode_xer_utf8(opt_codec_ctx, td, sptr, opt_mname,
|
|
buf_ptr, size);
|
|
if(rc.code == RC_OK) {
|
|
/*
|
|
* Now we have a whole string in UTF-8 format.
|
|
* Convert it into UCS-4.
|
|
*/
|
|
uint32_t *wcs;
|
|
size_t wcs_len;
|
|
UTF8String_t *st;
|
|
#ifndef WORDS_BIGENDIAN
|
|
int little_endian = 1;
|
|
#endif
|
|
|
|
assert(*sptr);
|
|
st = (UTF8String_t *)*sptr;
|
|
assert(st->buf);
|
|
wcs_len = UTF8String_to_wcs(st, 0, 0);
|
|
|
|
wcs = (uint32_t *)MALLOC(4 * (wcs_len + 1));
|
|
if(wcs == 0 || UTF8String_to_wcs(st, wcs, wcs_len) != wcs_len) {
|
|
rc.code = RC_FAIL;
|
|
rc.consumed = 0;
|
|
return rc;
|
|
} else {
|
|
wcs[wcs_len] = 0; /* nul-terminate */
|
|
}
|
|
|
|
#ifndef WORDS_BIGENDIAN
|
|
if(*(char *)&little_endian) {
|
|
/* Swap byte order in encoding */
|
|
uint32_t *wc = wcs;
|
|
uint32_t *wc_end = wcs + wcs_len;
|
|
for(; wc < wc_end; wc++) {
|
|
/* *wc = htonl(*wc); */
|
|
uint32_t wch = *wc;
|
|
*((uint8_t *)wc + 0) = wch >> 24;
|
|
*((uint8_t *)wc + 1) = wch >> 16;
|
|
*((uint8_t *)wc + 2) = wch >> 8;
|
|
*((uint8_t *)wc + 3) = wch;
|
|
}
|
|
}
|
|
#endif /* WORDS_BIGENDIAN */
|
|
|
|
FREEMEM(st->buf);
|
|
st->buf = (uint8_t *)wcs;
|
|
st->size = 4 * wcs_len;
|
|
}
|
|
return rc;
|
|
}
|
|
|
|
asn_enc_rval_t
|
|
UniversalString_encode_xer(asn_TYPE_descriptor_t *td, void *sptr,
|
|
int ilevel, enum xer_encoder_flags_e flags,
|
|
asn_app_consume_bytes_f *cb, void *app_key) {
|
|
const UniversalString_t *st = (const UniversalString_t *)sptr;
|
|
asn_enc_rval_t er;
|
|
|
|
(void)ilevel;
|
|
(void)flags;
|
|
|
|
if(!st || !st->buf)
|
|
_ASN_ENCODE_FAILED;
|
|
|
|
er.encoded = UniversalString__dump(st, cb, app_key);
|
|
if(er.encoded < 0) _ASN_ENCODE_FAILED;
|
|
|
|
_ASN_ENCODED_OK(er);
|
|
}
|
|
|
|
int
|
|
UniversalString_print(asn_TYPE_descriptor_t *td, const void *sptr, int ilevel,
|
|
asn_app_consume_bytes_f *cb, void *app_key) {
|
|
const UniversalString_t *st = (const UniversalString_t *)sptr;
|
|
|
|
(void)td; /* Unused argument */
|
|
(void)ilevel; /* Unused argument */
|
|
|
|
if(!st || !st->buf) return (cb("<absent>", 8, app_key) < 0) ? -1 : 0;
|
|
|
|
if(UniversalString__dump(st, cb, app_key) < 0)
|
|
return -1;
|
|
|
|
return 0;
|
|
}
|
|
|