vlm | fa67ddc | 2004-06-03 03:38:44 +0000 | [diff] [blame] | 1 | /*- |
| 2 | * Copyright (c) 2003 Lev Walkin <vlm@lionet.info>. All rights reserved. |
| 3 | * Redistribution and modifications are permitted subject to BSD license. |
| 4 | */ |
| 5 | #include <BMPString.h> |
| 6 | |
| 7 | /* |
| 8 | * BMPString basic type description. |
| 9 | */ |
| 10 | static ber_tlv_tag_t asn1_DEF_BMPString_tags[] = { |
| 11 | (ASN_TAG_CLASS_UNIVERSAL | (30 << 2)) |
| 12 | }; |
| 13 | asn1_TYPE_descriptor_t asn1_DEF_BMPString = { |
| 14 | "BMPString", |
| 15 | asn_generic_no_constraint, /* No constraint by default */ |
| 16 | OCTET_STRING_decode_ber, /* Implemented in terms of OCTET STRING */ |
| 17 | OCTET_STRING_encode_der, /* Implemented in terms of OCTET STRING */ |
| 18 | BMPString_print, |
| 19 | OCTET_STRING_free, /* -//- */ |
| 20 | 0, /* Use generic outmost tag fetcher */ |
| 21 | asn1_DEF_BMPString_tags, |
| 22 | sizeof(asn1_DEF_BMPString_tags) |
| 23 | / sizeof(asn1_DEF_BMPString_tags[0]), |
| 24 | 1, /* Single UNIVERSAL tag may be implicitly overriden */ |
| 25 | -1, /* Both ways are fine */ |
vlm | e413c12 | 2004-08-20 13:23:42 +0000 | [diff] [blame] | 26 | 0, 0, /* No members */ |
vlm | b42843a | 2004-06-05 08:17:50 +0000 | [diff] [blame] | 27 | 0 /* No specifics */ |
vlm | fa67ddc | 2004-06-03 03:38:44 +0000 | [diff] [blame] | 28 | }; |
| 29 | |
| 30 | /* |
| 31 | * BMPString specific contents printer. |
| 32 | */ |
| 33 | int |
| 34 | BMPString_print(asn1_TYPE_descriptor_t *td, const void *sptr, int ilevel, |
| 35 | asn_app_consume_bytes_f *cb, void *app_key) { |
vlm | da67468 | 2004-08-11 09:07:36 +0000 | [diff] [blame] | 36 | const BMPString_t *st = (const BMPString_t *)sptr; |
vlm | fa67ddc | 2004-06-03 03:38:44 +0000 | [diff] [blame] | 37 | uint16_t *wchar; |
| 38 | uint16_t *wend; |
| 39 | char scratch[128]; /* Scratchpad buffer */ |
| 40 | char *p; |
| 41 | |
vlm | b42843a | 2004-06-05 08:17:50 +0000 | [diff] [blame] | 42 | (void)td; /* Unused argument */ |
| 43 | (void)ilevel; /* Unused argument */ |
| 44 | |
vlm | fa67ddc | 2004-06-03 03:38:44 +0000 | [diff] [blame] | 45 | if(!st || !st->buf) return cb("<absent>", 8, app_key); |
| 46 | |
| 47 | wchar = (uint16_t *)st->buf; |
| 48 | wend = (uint16_t *)(st->buf + st->size); |
| 49 | for(p = scratch; wchar < wend; wchar++) { |
| 50 | uint16_t wc = (((uint8_t *)wchar)[0] << 8) |
| 51 | | ((uint8_t *)wchar)[1]; /* 2 bytes */ |
| 52 | if(sizeof(scratch) - (p - scratch) < 3) { |
| 53 | if(cb(scratch, p - scratch, app_key)) |
| 54 | return -1; |
| 55 | p = scratch; |
| 56 | } |
| 57 | if(wc < 0x80) { |
| 58 | *p++ = (char)wc; |
| 59 | } else if(wc < 0x800) { |
| 60 | *p++ = 0xc0 | ((wc >> 6)); |
| 61 | *p++ = 0x80 | ((wc & 0x3f)); |
| 62 | } else { |
| 63 | *p++ = 0xe0 | ((wc >> 12)); |
| 64 | *p++ = 0x80 | ((wc >> 6) & 0x3f); |
| 65 | *p++ = 0x80 | ((wc & 0x3f)); |
| 66 | } |
| 67 | } |
| 68 | |
| 69 | return cb(scratch, p - scratch, app_key); |
| 70 | } |