vlm | fa67ddc | 2004-06-03 03:38:44 +0000 | [diff] [blame] | 1 | /*- |
vlm | a29c5bb | 2004-10-23 11:20:06 +0000 | [diff] [blame] | 2 | * Copyright (c) 2003, 2004 Lev Walkin <vlm@lionet.info>. All rights reserved. |
vlm | fa67ddc | 2004-06-03 03:38:44 +0000 | [diff] [blame] | 3 | * Redistribution and modifications are permitted subject to BSD license. |
| 4 | */ |
vlm | 39ba4c4 | 2004-09-22 16:06:28 +0000 | [diff] [blame] | 5 | #include <asn_internal.h> |
vlm | fa67ddc | 2004-06-03 03:38:44 +0000 | [diff] [blame] | 6 | #include <BMPString.h> |
vlm | a29c5bb | 2004-10-23 11:20:06 +0000 | [diff] [blame] | 7 | #include <UTF8String.h> |
vlm | fa67ddc | 2004-06-03 03:38:44 +0000 | [diff] [blame] | 8 | |
| 9 | /* |
| 10 | * BMPString basic type description. |
| 11 | */ |
vlm | ef6355b | 2004-09-29 13:26:15 +0000 | [diff] [blame] | 12 | static ber_tlv_tag_t asn_DEF_BMPString_tags[] = { |
vlm | 72425de | 2004-09-13 08:31:01 +0000 | [diff] [blame] | 13 | (ASN_TAG_CLASS_UNIVERSAL | (30 << 2)), /* [UNIVERSAL 30] IMPLICIT ...*/ |
| 14 | (ASN_TAG_CLASS_UNIVERSAL | (4 << 2)) /* ... OCTET STRING */ |
vlm | fa67ddc | 2004-06-03 03:38:44 +0000 | [diff] [blame] | 15 | }; |
vlm | ef6355b | 2004-09-29 13:26:15 +0000 | [diff] [blame] | 16 | asn_TYPE_descriptor_t asn_DEF_BMPString = { |
vlm | fa67ddc | 2004-06-03 03:38:44 +0000 | [diff] [blame] | 17 | "BMPString", |
vlm | 9de248e | 2004-10-20 15:50:55 +0000 | [diff] [blame] | 18 | "BMPString", |
vlm | 39ba4c4 | 2004-09-22 16:06:28 +0000 | [diff] [blame] | 19 | OCTET_STRING_free, /* Implemented in terms of OCTET STRING */ |
| 20 | BMPString_print, |
vlm | fa67ddc | 2004-06-03 03:38:44 +0000 | [diff] [blame] | 21 | asn_generic_no_constraint, /* No constraint by default */ |
vlm | a29c5bb | 2004-10-23 11:20:06 +0000 | [diff] [blame] | 22 | OCTET_STRING_decode_ber, |
| 23 | OCTET_STRING_encode_der, |
| 24 | BMPString_decode_xer, /* Convert from UTF-8 */ |
| 25 | BMPString_encode_xer, /* Convert to UTF-8 */ |
vlm | 337167e | 2005-11-26 11:25:14 +0000 | [diff] [blame] | 26 | 0, |
vlm | fa67ddc | 2004-06-03 03:38:44 +0000 | [diff] [blame] | 27 | 0, /* Use generic outmost tag fetcher */ |
vlm | ef6355b | 2004-09-29 13:26:15 +0000 | [diff] [blame] | 28 | asn_DEF_BMPString_tags, |
| 29 | sizeof(asn_DEF_BMPString_tags) |
| 30 | / sizeof(asn_DEF_BMPString_tags[0]) - 1, |
| 31 | asn_DEF_BMPString_tags, |
| 32 | sizeof(asn_DEF_BMPString_tags) |
| 33 | / sizeof(asn_DEF_BMPString_tags[0]), |
vlm | 337167e | 2005-11-26 11:25:14 +0000 | [diff] [blame] | 34 | 0, /* No PER visible constraints */ |
vlm | e413c12 | 2004-08-20 13:23:42 +0000 | [diff] [blame] | 35 | 0, 0, /* No members */ |
vlm | b42843a | 2004-06-05 08:17:50 +0000 | [diff] [blame] | 36 | 0 /* No specifics */ |
vlm | fa67ddc | 2004-06-03 03:38:44 +0000 | [diff] [blame] | 37 | }; |
| 38 | |
| 39 | /* |
| 40 | * BMPString specific contents printer. |
| 41 | */ |
vlm | 39ba4c4 | 2004-09-22 16:06:28 +0000 | [diff] [blame] | 42 | static ssize_t |
| 43 | BMPString__dump(const BMPString_t *st, |
vlm | fa67ddc | 2004-06-03 03:38:44 +0000 | [diff] [blame] | 44 | asn_app_consume_bytes_f *cb, void *app_key) { |
vlm | fa67ddc | 2004-06-03 03:38:44 +0000 | [diff] [blame] | 45 | char scratch[128]; /* Scratchpad buffer */ |
vlm | 39ba4c4 | 2004-09-22 16:06:28 +0000 | [diff] [blame] | 46 | char *p = scratch; |
| 47 | ssize_t wrote = 0; |
| 48 | uint8_t *ch; |
| 49 | uint8_t *end; |
vlm | fa67ddc | 2004-06-03 03:38:44 +0000 | [diff] [blame] | 50 | |
vlm | 39ba4c4 | 2004-09-22 16:06:28 +0000 | [diff] [blame] | 51 | ch = st->buf; |
| 52 | end = (st->buf + st->size); |
| 53 | for(end--; ch < end; ch += 2) { |
| 54 | uint16_t wc = (ch[0] << 8) | ch[1]; /* 2 bytes */ |
vlm | fa67ddc | 2004-06-03 03:38:44 +0000 | [diff] [blame] | 55 | if(sizeof(scratch) - (p - scratch) < 3) { |
vlm | 39ba4c4 | 2004-09-22 16:06:28 +0000 | [diff] [blame] | 56 | wrote += p - scratch; |
| 57 | if(cb(scratch, p - scratch, app_key) < 0) |
vlm | fa67ddc | 2004-06-03 03:38:44 +0000 | [diff] [blame] | 58 | return -1; |
| 59 | p = scratch; |
| 60 | } |
| 61 | if(wc < 0x80) { |
| 62 | *p++ = (char)wc; |
| 63 | } else if(wc < 0x800) { |
| 64 | *p++ = 0xc0 | ((wc >> 6)); |
| 65 | *p++ = 0x80 | ((wc & 0x3f)); |
| 66 | } else { |
| 67 | *p++ = 0xe0 | ((wc >> 12)); |
| 68 | *p++ = 0x80 | ((wc >> 6) & 0x3f); |
| 69 | *p++ = 0x80 | ((wc & 0x3f)); |
| 70 | } |
| 71 | } |
| 72 | |
vlm | 39ba4c4 | 2004-09-22 16:06:28 +0000 | [diff] [blame] | 73 | wrote += p - scratch; |
| 74 | if(cb(scratch, p - scratch, app_key) < 0) |
| 75 | return -1; |
| 76 | |
| 77 | return wrote; |
vlm | fa67ddc | 2004-06-03 03:38:44 +0000 | [diff] [blame] | 78 | } |
vlm | 39ba4c4 | 2004-09-22 16:06:28 +0000 | [diff] [blame] | 79 | |
vlm | a29c5bb | 2004-10-23 11:20:06 +0000 | [diff] [blame] | 80 | asn_dec_rval_t |
| 81 | BMPString_decode_xer(asn_codec_ctx_t *opt_codec_ctx, |
| 82 | asn_TYPE_descriptor_t *td, void **sptr, |
vlm | b02dcc6 | 2005-03-10 18:52:02 +0000 | [diff] [blame] | 83 | const char *opt_mname, const void *buf_ptr, size_t size) { |
vlm | a29c5bb | 2004-10-23 11:20:06 +0000 | [diff] [blame] | 84 | asn_dec_rval_t rc; |
| 85 | |
| 86 | rc = OCTET_STRING_decode_xer_utf8(opt_codec_ctx, td, sptr, opt_mname, |
| 87 | buf_ptr, size); |
| 88 | if(rc.code == RC_OK) { |
| 89 | /* |
| 90 | * Now we have a whole string in UTF-8 format. |
| 91 | * Convert it into UCS-2. |
| 92 | */ |
| 93 | uint32_t *wcs; |
| 94 | size_t wcs_len; |
| 95 | UTF8String_t *st; |
| 96 | |
| 97 | assert(*sptr); |
| 98 | st = (UTF8String_t *)*sptr; |
| 99 | assert(st->buf); |
| 100 | wcs_len = UTF8String_to_wcs(st, 0, 0); |
| 101 | |
| 102 | wcs = (uint32_t *)MALLOC(4 * (wcs_len + 1)); |
| 103 | if(wcs == 0 || UTF8String_to_wcs(st, wcs, wcs_len) != wcs_len) { |
| 104 | rc.code = RC_FAIL; |
| 105 | rc.consumed = 0; |
| 106 | return rc; |
| 107 | } else { |
| 108 | wcs[wcs_len] = 0; /* nul-terminate */ |
| 109 | } |
| 110 | |
| 111 | if(1) { |
| 112 | /* Swap byte order and trim encoding to 2 bytes */ |
| 113 | uint32_t *wc = wcs; |
| 114 | uint32_t *wc_end = wcs + wcs_len + 1; |
| 115 | uint16_t *dstwc = (uint16_t *)wcs; |
| 116 | for(; wc < wc_end; wc++, dstwc++) { |
| 117 | uint32_t wch = *wc; |
| 118 | if(wch > 0xffff) { |
| 119 | FREEMEM(wcs); |
| 120 | rc.code = RC_FAIL; |
| 121 | rc.consumed = 0; |
| 122 | return rc; |
| 123 | } |
| 124 | *((uint8_t *)dstwc + 0) = wch >> 8; |
| 125 | *((uint8_t *)dstwc + 1) = wch; |
| 126 | } |
vlm | 9cb2b16 | 2004-10-23 13:13:19 +0000 | [diff] [blame] | 127 | dstwc = (uint16_t *)REALLOC(wcs, 2 * (wcs_len + 1)); |
vlm | a29c5bb | 2004-10-23 11:20:06 +0000 | [diff] [blame] | 128 | if(!dstwc) { |
| 129 | FREEMEM(wcs); |
| 130 | rc.code = RC_FAIL; |
| 131 | rc.consumed = 0; |
| 132 | return rc; |
| 133 | } else { |
| 134 | wcs = (uint32_t *)dstwc; |
| 135 | } |
| 136 | } |
| 137 | |
| 138 | FREEMEM(st->buf); |
| 139 | st->buf = (uint8_t *)wcs; |
| 140 | st->size = 2 * wcs_len; |
| 141 | } |
| 142 | return rc; |
| 143 | } |
| 144 | |
vlm | 39ba4c4 | 2004-09-22 16:06:28 +0000 | [diff] [blame] | 145 | asn_enc_rval_t |
vlm | ef6355b | 2004-09-29 13:26:15 +0000 | [diff] [blame] | 146 | BMPString_encode_xer(asn_TYPE_descriptor_t *td, void *sptr, |
vlm | 39ba4c4 | 2004-09-22 16:06:28 +0000 | [diff] [blame] | 147 | int ilevel, enum xer_encoder_flags_e flags, |
| 148 | asn_app_consume_bytes_f *cb, void *app_key) { |
| 149 | const BMPString_t *st = (const BMPString_t *)sptr; |
| 150 | asn_enc_rval_t er; |
| 151 | |
| 152 | (void)ilevel; |
| 153 | (void)flags; |
| 154 | |
| 155 | if(!st || !st->buf) |
| 156 | _ASN_ENCODE_FAILED; |
| 157 | |
| 158 | er.encoded = BMPString__dump(st, cb, app_key); |
| 159 | if(er.encoded < 0) _ASN_ENCODE_FAILED; |
| 160 | |
vlm | 337167e | 2005-11-26 11:25:14 +0000 | [diff] [blame] | 161 | _ASN_ENCODED_OK(er); |
vlm | 39ba4c4 | 2004-09-22 16:06:28 +0000 | [diff] [blame] | 162 | } |
| 163 | |
| 164 | int |
vlm | ef6355b | 2004-09-29 13:26:15 +0000 | [diff] [blame] | 165 | BMPString_print(asn_TYPE_descriptor_t *td, const void *sptr, int ilevel, |
vlm | 39ba4c4 | 2004-09-22 16:06:28 +0000 | [diff] [blame] | 166 | asn_app_consume_bytes_f *cb, void *app_key) { |
| 167 | const BMPString_t *st = (const BMPString_t *)sptr; |
| 168 | |
| 169 | (void)td; /* Unused argument */ |
| 170 | (void)ilevel; /* Unused argument */ |
| 171 | |
vlm | 6678cb1 | 2004-09-26 13:10:40 +0000 | [diff] [blame] | 172 | if(!st || !st->buf) |
| 173 | return (cb("<absent>", 8, app_key) < 0) ? -1 : 0; |
vlm | 39ba4c4 | 2004-09-22 16:06:28 +0000 | [diff] [blame] | 174 | |
| 175 | if(BMPString__dump(st, cb, app_key) < 0) |
| 176 | return -1; |
| 177 | |
| 178 | return 0; |
| 179 | } |
| 180 | |