ViewVC Help
View File | Revision Log | Show Annotations | Download File
/cvs/Convert-BER-XS/XS.xs
Revision: 1.11
Committed: Sat Apr 20 12:25:23 2019 UTC (5 years, 1 month ago) by root
Branch: MAIN
Changes since 1.10: +7 -4 lines
Log Message:
*** empty log message ***

File Contents

# User Rev Content
1 root 1.1 #include "EXTERN.h"
2     #include "perl.h"
3     #include "XSUB.h"
4    
5     // C99 required
6    
7     enum {
8     // ASN_TAG
9     ASN_BOOLEAN = 0x01,
10     ASN_INTEGER32 = 0x02,
11     ASN_BIT_STRING = 0x03,
12     ASN_OCTET_STRING = 0x04,
13     ASN_NULL = 0x05,
14     ASN_OBJECT_IDENTIFIER = 0x06,
15 root 1.8 ASN_OID = 0x06,
16     ASN_OBJECT_DESCRIPTOR = 0x07,
17     ASN_EXTERNAL = 0x08,
18     ASN_REAL = 0x09,
19     ASN_ENUMERATED = 0x0a,
20     ASN_EMBEDDED_PDV = 0x0b,
21     ASN_UTF8_STRING = 0x0c,
22     ASN_RELATIVE_OID = 0x0d,
23 root 1.1 ASN_SEQUENCE = 0x10,
24 root 1.8 ASN_SET = 0x11,
25     ASN_NUMERIC_STRING = 0x12,
26     ASN_PRINTABLE_STRING = 0x13,
27     ASN_TELETEX_STRING = 0x14,
28     ASN_T61_STRING = 0x14,
29     ASN_VIDEOTEX_STRING = 0x15,
30     ASN_IA5_STRING = 0x16,
31     ASN_ASCII_STRING = 0x16,
32     ASN_UTC_TIME = 0x17,
33     ASN_GENERALIZED_TIME = 0x18,
34     ASN_GRAPHIC_STRING = 0x19,
35     ASN_VISIBLE_STRING = 0x1a,
36     ASN_ISO646_STRING = 0x1a,
37     ASN_GENERAL_STRING = 0x1b,
38     ASN_UNIVERSAL_STRING = 0x1c,
39     ASN_CHARACTER_STRING = 0x1d,
40     ASN_BMP_STRING = 0x1e,
41 root 1.1
42     ASN_TAG_BER = 0x1f,
43     ASN_TAG_MASK = 0x1f,
44    
45     // primitive/constructed
46     ASN_CONSTRUCTED = 0x20,
47    
48     // ASN_CLASS
49     ASN_UNIVERSAL = 0x00,
50 root 1.5 ASN_APPLICATION = 0x01,
51     ASN_CONTEXT = 0x02,
52     ASN_PRIVATE = 0x03,
53 root 1.1
54     ASN_CLASS_MASK = 0xc0,
55     ASN_CLASS_SHIFT = 6,
56    
57 root 1.2 // ASN_APPLICATION SNMP
58 root 1.3 SNMP_IPADDRESS = 0x00,
59     SNMP_COUNTER32 = 0x01,
60     SNMP_UNSIGNED32 = 0x02,
61     SNMP_TIMETICKS = 0x03,
62     SNMP_OPAQUE = 0x04,
63     SNMP_COUNTER64 = 0x06,
64 root 1.1 };
65    
66     enum {
67 root 1.5 BER_TYPE_BYTES,
68     BER_TYPE_UTF8,
69     BER_TYPE_UCS2,
70     BER_TYPE_UCS4,
71     BER_TYPE_INT,
72     BER_TYPE_OID,
73     BER_TYPE_RELOID,
74     BER_TYPE_NULL,
75     BER_TYPE_BOOL,
76     BER_TYPE_REAL,
77 root 1.6 BER_TYPE_IPADDRESS,
78 root 1.5 BER_TYPE_CROAK,
79     };
80    
81     enum {
82 root 1.1 BER_CLASS = 0,
83     BER_TAG = 1,
84     BER_CONSTRUCTED = 2,
85     BER_DATA = 3,
86     BER_ARRAYSIZE
87     };
88    
89     #define MAX_OID_STRLEN 4096
90    
91 root 1.5 typedef void profile_type;
92    
93     static profile_type *cur_profile, *default_profile;
94 root 1.3 static SV *buf_sv; // encoding buffer
95     static U8 *buf, *cur, *end; // buffer start, current, end
96    
97 root 1.9 #if PERL_VERSION < 18
98     # define utf8_to_uvchr_buf(s,e,l) utf8_to_uvchr (s, l)
99     #endif
100    
101 root 1.3 #if __GNUC__ >= 3
102     # define expect(expr,value) __builtin_expect ((expr), (value))
103     # define INLINE static inline
104     #else
105     # define expect(expr,value) (expr)
106     # define INLINE static
107     #endif
108    
109     #define expect_false(expr) expect ((expr) != 0, 0)
110     #define expect_true(expr) expect ((expr) != 0, 1)
111 root 1.1
112 root 1.5 /////////////////////////////////////////////////////////////////////////////
113    
114     static SV *sviv_cache[32];
115    
116 root 1.1 // for "small" integers, return a readonly sv, otherwise create a new one
117     static SV *newSVcacheint (int val)
118     {
119 root 1.5 if (expect_false (val < 0 || val >= sizeof (sviv_cache)))
120 root 1.1 return newSViv (val);
121    
122 root 1.5 if (expect_false (!sviv_cache [val]))
123 root 1.1 {
124 root 1.5 sviv_cache [val] = newSVuv (val);
125     SvREADONLY_on (sviv_cache [val]);
126 root 1.1 }
127    
128 root 1.5 return SvREFCNT_inc_NN (sviv_cache [val]);
129     }
130    
131     /////////////////////////////////////////////////////////////////////////////
132    
133     static HV *profile_stash;
134    
135     static profile_type *
136     SvPROFILE (SV *profile)
137     {
138     if (!SvOK (profile))
139 root 1.6 return default_profile;
140 root 1.5
141     if (!SvROK (profile))
142     croak ("invalid profile");
143    
144     profile = SvRV (profile);
145    
146     if (SvSTASH (profile) != profile_stash)
147     croak ("invalid profile object");
148    
149     return (void *)profile;
150     }
151    
152     static int
153     profile_lookup (profile_type *profile, int klass, int tag)
154     {
155     SV *sv = (SV *)profile;
156     U32 idx = (tag << 2) + klass;
157    
158     if (expect_false (idx >= SvCUR (sv)))
159     return BER_TYPE_BYTES;
160    
161     return SvPVX (sv)[idx];
162     }
163    
164 root 1.10 static void
165 root 1.5 profile_set (profile_type *profile, int klass, int tag, int type)
166     {
167     SV *sv = (SV *)profile;
168     U32 idx = (tag << 2) + klass;
169     STRLEN oldlen = SvCUR (sv);
170     STRLEN newlen = idx + 2;
171    
172     if (idx >= oldlen)
173     {
174     sv_grow (sv, newlen);
175     memset (SvPVX (sv) + oldlen, BER_TYPE_BYTES, newlen - oldlen);
176     SvCUR_set (sv, newlen);
177     }
178    
179     SvPVX (sv)[idx] = type;
180     }
181    
182     static SV *
183     profile_new ()
184     {
185     SV *sv = newSVpvn ("", 0);
186    
187     static const struct {
188     int klass;
189     int tag;
190     int type;
191     } *celem, default_map[] = {
192     { ASN_UNIVERSAL, ASN_BOOLEAN , BER_TYPE_BOOL },
193     { ASN_UNIVERSAL, ASN_INTEGER32 , BER_TYPE_INT },
194     { ASN_UNIVERSAL, ASN_NULL , BER_TYPE_NULL },
195     { ASN_UNIVERSAL, ASN_OBJECT_IDENTIFIER, BER_TYPE_OID },
196     { ASN_UNIVERSAL, ASN_OBJECT_DESCRIPTOR, BER_TYPE_OID },
197     { ASN_UNIVERSAL, ASN_RELATIVE_OID , BER_TYPE_RELOID },
198     { ASN_UNIVERSAL, ASN_REAL , BER_TYPE_REAL },
199     { ASN_UNIVERSAL, ASN_UTF8_STRING , BER_TYPE_UTF8 },
200     { ASN_UNIVERSAL, ASN_BMP_STRING , BER_TYPE_UCS2 },
201     { ASN_UNIVERSAL, ASN_UNIVERSAL_STRING , BER_TYPE_UCS4 },
202     };
203    
204 root 1.11 for (celem = default_map + sizeof (default_map) / sizeof (default_map [0]); celem-- > default_map; )
205     profile_set ((profile_type *)sv, celem->klass, celem->tag, celem->type);
206 root 1.5
207     return sv_bless (newRV_noinc (sv), profile_stash);
208 root 1.1 }
209    
210     /////////////////////////////////////////////////////////////////////////////
211 root 1.3 // decoder
212 root 1.1
213     static void
214     error (const char *errmsg)
215     {
216     croak ("%s at offset 0x%04x", errmsg, cur - buf);
217     }
218    
219 root 1.3 static void
220     want (UV count)
221 root 1.1 {
222 root 1.3 if (expect_false ((uintptr_t)(end - cur) < count))
223     error ("unexpected end of message buffer");
224 root 1.1 }
225    
226 root 1.2 // get_* functions fetch something from the buffer
227     // decode_* functions use get_* fun ctions to decode ber values
228    
229 root 1.3 // get n octets
230 root 1.1 static U8 *
231 root 1.3 get_n (UV count)
232 root 1.1 {
233 root 1.3 want (count);
234 root 1.1 U8 *res = cur;
235     cur += count;
236     return res;
237     }
238    
239 root 1.3 // get single octet
240 root 1.1 static U8
241 root 1.2 get_u8 (void)
242 root 1.1 {
243 root 1.3 if (cur == end)
244     error ("unexpected end of message buffer");
245 root 1.1
246     return *cur++;
247     }
248    
249 root 1.3 // get ber-encoded integer (i.e. pack "w")
250 root 1.1 static U32
251 root 1.3 get_w (void)
252 root 1.1 {
253     U32 res = 0;
254    
255     for (;;)
256     {
257 root 1.2 U8 c = get_u8 ();
258 root 1.1 res = (res << 7) | (c & 0x7f);
259    
260     if (!(c & 0x80))
261     return res;
262     }
263     }
264    
265     static U32
266 root 1.2 get_length (void)
267 root 1.1 {
268 root 1.2 U32 res = get_u8 ();
269 root 1.1
270     if (res & 0x80)
271     {
272     int cnt = res & 0x7f;
273     res = 0;
274    
275     switch (cnt)
276     {
277     case 0:
278     error ("indefinite ASN.1 lengths not supported");
279     return 0;
280    
281     default:
282     error ("ASN.1 length too long");
283     return 0;
284    
285 root 1.2 case 4: res = (res << 8) | get_u8 ();
286     case 3: res = (res << 8) | get_u8 ();
287     case 2: res = (res << 8) | get_u8 ();
288     case 1: res = (res << 8) | get_u8 ();
289 root 1.1 }
290     }
291    
292     return res;
293     }
294    
295     static SV *
296 root 1.5 decode_int ()
297 root 1.1 {
298 root 1.5 int len = get_length ();
299 root 1.1
300 root 1.5 if (len <= 0)
301 root 1.1 {
302 root 1.5 error ("integer length equal to zero");
303 root 1.1 return 0;
304     }
305    
306 root 1.5 U8 *data = get_n (len);
307 root 1.1
308 root 1.5 int negative = data [0] & 0x80;
309 root 1.1
310 root 1.5 UV val = negative ? -1 : 0; // copy signbit to all bits
311 root 1.1
312 root 1.5 do
313     val = (val << 8) | *data++;
314     while (--len);
315 root 1.1
316 root 1.6 // the cast to IV relies on implementation-defined behaviour (two's complement cast)
317 root 1.5 // but that's ok, as perl relies on it as well.
318     return negative ? newSViv ((IV)val) : newSVuv (val);
319 root 1.1 }
320    
321     static SV *
322 root 1.5 decode_data (void)
323 root 1.1 {
324 root 1.5 U32 len = get_length ();
325     U8 *data = get_n (len);
326     return newSVpvn ((char *)data, len);
327 root 1.1 }
328    
329 root 1.2 // gelper for decode_object_identifier
330 root 1.1 static char *
331     write_uv (char *buf, U32 u)
332     {
333     // the one-digit case is absolutely predominant, so this pays off (hopefully)
334 root 1.5 if (expect_true (u < 10))
335 root 1.1 *buf++ = u + '0';
336     else
337     {
338     char *beg = buf;
339    
340     do
341     {
342     *buf++ = u % 10 + '0';
343     u /= 10;
344     }
345     while (u);
346    
347     // reverse digits
348 root 1.11 char *ptr = buf;
349     while (--ptr != beg)
350 root 1.1 {
351     char c = *ptr;
352     *ptr = *beg;
353     *beg = c;
354 root 1.11 ++beg;
355 root 1.1 }
356     }
357    
358     return buf;
359     }
360    
361     static SV *
362 root 1.5 decode_oid (int relative)
363 root 1.1 {
364 root 1.5 U32 len = get_length ();
365 root 1.1
366 root 1.5 if (len <= 0)
367 root 1.1 {
368     error ("OBJECT IDENTIFIER length equal to zero");
369     return &PL_sv_undef;
370     }
371    
372 root 1.5 U8 *end = cur + len;
373 root 1.3 U32 w = get_w ();
374 root 1.1
375     static char oid[MAX_OID_STRLEN]; // must be static
376     char *app = oid;
377    
378 root 1.5 if (relative)
379     app = write_uv (app, w);
380     else
381     {
382     app = write_uv (app, (U8)w / 40);
383     *app++ = '.';
384     app = write_uv (app, (U8)w % 40);
385     }
386 root 1.1
387     // we assume an oid component is never > 64 bytes
388     while (cur < end && oid + sizeof (oid) - app > 64)
389     {
390 root 1.3 w = get_w ();
391 root 1.1 *app++ = '.';
392     app = write_uv (app, w);
393     }
394    
395     return newSVpvn (oid, app - oid);
396     }
397    
398 root 1.7 // TODO: this is unacceptably slow
399     static SV *
400     decode_ucs (int chrsize)
401     {
402     SV *res = NEWSV (0, 0);
403    
404     U32 len = get_length ();
405    
406     if (len & (chrsize - 1))
407     croak ("BER_TYPE_UCS has an invalid number of octets (%d)", len);
408    
409     while (len)
410     {
411     U8 b1 = get_u8 ();
412     U8 b2 = get_u8 ();
413     U32 chr = (b1 << 8) | b2;
414    
415     if (chrsize == 4)
416     {
417     U8 b3 = get_u8 ();
418     U8 b4 = get_u8 ();
419     chr = (chr << 16) | (b3 << 8) | b4;
420     }
421    
422     U8 uchr [UTF8_MAXBYTES];
423     int uclen = uvuni_to_utf8 (uchr, chr) - uchr;
424    
425     sv_catpvn (res, (const char *)uchr, uclen);
426     len -= chrsize;
427     }
428    
429     SvUTF8_on (res);
430    
431     return res;
432     }
433    
434 root 1.1 static SV *
435 root 1.2 decode_ber ()
436 root 1.1 {
437 root 1.2 int identifier = get_u8 ();
438 root 1.1
439     SV *res;
440    
441 root 1.5 int constructed = identifier & ASN_CONSTRUCTED;
442     int klass = (identifier & ASN_CLASS_MASK) >> ASN_CLASS_SHIFT;
443     int tag = identifier & ASN_TAG_MASK;
444 root 1.1
445     if (tag == ASN_TAG_BER)
446 root 1.3 tag = get_w ();
447 root 1.1
448     if (tag == ASN_TAG_BER)
449 root 1.3 tag = get_w ();
450 root 1.1
451     if (constructed)
452     {
453 root 1.2 U32 len = get_length ();
454 root 1.1 U32 seqend = (cur - buf) + len;
455     AV *av = (AV *)sv_2mortal ((SV *)newAV ());
456    
457     while (cur < buf + seqend)
458 root 1.2 av_push (av, decode_ber ());
459 root 1.1
460     if (cur > buf + seqend)
461     croak ("constructed type %02x overflow (%x %x)\n", identifier, cur - buf, seqend);
462    
463     res = newRV_inc ((SV *)av);
464     }
465     else
466 root 1.5 switch (profile_lookup (cur_profile, klass, tag))
467 root 1.1 {
468 root 1.5 case BER_TYPE_NULL:
469 root 1.1 res = &PL_sv_undef;
470     break;
471    
472 root 1.5 case BER_TYPE_BOOL:
473     {
474     U32 len = get_length ();
475    
476     if (len != 1)
477 root 1.6 croak ("BER_TYPE_BOOLEAN type with invalid length %d encountered", len);
478 root 1.5
479     res = newSVcacheint (get_u8 () ? 0 : 1);
480     }
481     break;
482    
483     case BER_TYPE_OID:
484     res = decode_oid (0);
485 root 1.1 break;
486    
487 root 1.5 case BER_TYPE_RELOID:
488     res = decode_oid (1);
489 root 1.1 break;
490    
491 root 1.5 case BER_TYPE_INT:
492     res = decode_int ();
493 root 1.1 break;
494    
495 root 1.5 case BER_TYPE_UTF8:
496     res = decode_data ();
497     SvUTF8_on (res);
498 root 1.1 break;
499    
500 root 1.5 case BER_TYPE_BYTES:
501     res = decode_data ();
502 root 1.1 break;
503    
504 root 1.6 case BER_TYPE_IPADDRESS:
505     {
506     U32 len = get_length ();
507    
508     if (len != 4)
509     croak ("BER_TYPE_IPADDRESS type with invalid length %d encountered", len);
510    
511     U8 c1 = get_u8 ();
512     U8 c2 = get_u8 ();
513     U8 c3 = get_u8 ();
514     U8 c4 = get_u8 ();
515    
516     res = newSVpvf ("%d.%d.%d.%d", c1, c2, c3, c4);
517     }
518     break;
519    
520 root 1.5 case BER_TYPE_UCS2:
521 root 1.7 res = decode_ucs (2);
522     break;
523    
524 root 1.5 case BER_TYPE_UCS4:
525 root 1.7 res = decode_ucs (4);
526     break;
527    
528     case BER_TYPE_REAL:
529 root 1.5 case BER_TYPE_CROAK:
530 root 1.1 default:
531 root 1.5 croak ("unconfigured/unsupported class/tag %d/%d", klass, tag);
532 root 1.1 }
533    
534     AV *av = newAV ();
535     av_fill (av, BER_ARRAYSIZE - 1);
536 root 1.5 AvARRAY (av)[BER_CLASS ] = newSVcacheint (klass);
537 root 1.1 AvARRAY (av)[BER_TAG ] = newSVcacheint (tag);
538     AvARRAY (av)[BER_CONSTRUCTED] = newSVcacheint (constructed ? 1 : 0);
539     AvARRAY (av)[BER_DATA ] = res;
540    
541     return newRV_noinc ((SV *)av);
542     }
543    
544 root 1.3 /////////////////////////////////////////////////////////////////////////////
545     // encoder
546    
547     /* adds two STRLENs together, slow, and with paranoia */
548     static STRLEN
549     strlen_sum (STRLEN l1, STRLEN l2)
550     {
551     size_t sum = l1 + l2;
552    
553     if (sum < (size_t)l2 || sum != (size_t)(STRLEN)sum)
554     croak ("JSON::XS: string size overflow");
555    
556     return sum;
557     }
558    
559     static void
560     set_buf (SV *sv)
561     {
562     STRLEN len;
563     buf_sv = sv;
564 root 1.10 buf = (U8 *)SvPVbyte (buf_sv, len);
565 root 1.3 cur = buf;
566     end = buf + len;
567     }
568    
569     /* similar to SvGROW, but somewhat safer and guarantees exponential realloc strategy */
570     static char *
571     my_sv_grow (SV *sv, size_t len1, size_t len2)
572     {
573     len1 = strlen_sum (len1, len2);
574     len1 = strlen_sum (len1, len1 >> 1);
575    
576     if (len1 > 4096 - 24)
577     len1 = (len1 | 4095) - 24;
578    
579     return SvGROW (sv, len1);
580     }
581    
582     static void
583     need (STRLEN len)
584     {
585     if (expect_false ((uintptr_t)(end - cur) < len))
586     {
587     STRLEN pos = cur - buf;
588 root 1.10 buf = (U8 *)my_sv_grow (buf_sv, pos, len);
589 root 1.3 cur = buf + pos;
590     end = buf + SvLEN (buf_sv) - 1;
591     }
592     }
593    
594     static void
595     put_u8 (int val)
596     {
597     need (1);
598     *cur++ = val;
599     }
600    
601     static void
602     put_w_nocheck (U32 val)
603     {
604     *cur = (val >> 7 * 4) | 0x80; cur += val >= (1 << (7 * 4));
605     *cur = (val >> 7 * 3) | 0x80; cur += val >= (1 << (7 * 3));
606     *cur = (val >> 7 * 2) | 0x80; cur += val >= (1 << (7 * 2));
607     *cur = (val >> 7 * 1) | 0x80; cur += val >= (1 << (7 * 1));
608     *cur = val & 0x7f; cur += 1;
609     }
610    
611     static void
612     put_w (U32 val)
613     {
614     need (5); // we only handle up to 5 bytes
615    
616     put_w_nocheck (val);
617     }
618    
619     static U8 *
620     put_length_at (U32 val, U8 *cur)
621     {
622     if (val < 0x7fU)
623     *cur++ = val;
624     else
625     {
626     U8 *lenb = cur++;
627    
628     *cur = val >> 24; cur += *cur > 0;
629     *cur = val >> 16; cur += *cur > 0;
630     *cur = val >> 8; cur += *cur > 0;
631     *cur = val ; cur += 1;
632    
633     *lenb = 0x80 + cur - lenb - 1;
634     }
635    
636     return cur;
637     }
638    
639     static void
640     put_length (U32 val)
641     {
642 root 1.7 need (5 + val);
643 root 1.3 cur = put_length_at (val, cur);
644     }
645    
646     // return how many bytes the encoded length requires
647     static int length_length (U32 val)
648     {
649     return val < 0x7fU
650     ? 1
651     : 2 + (val > 0xffU) + (val > 0xffffU) + (val > 0xffffffU);
652     }
653    
654     static void
655 root 1.5 encode_data (const char *ptr, STRLEN len)
656 root 1.3 {
657     put_length (len);
658     memcpy (cur, ptr, len);
659     cur += len;
660     }
661    
662     static void
663 root 1.5 encode_uv (UV uv)
664     {
665     }
666    
667     static void
668     encode_int (SV *sv)
669 root 1.3 {
670 root 1.5 need (8 + 1 + 1); // 64 bit + length + extra 0
671    
672     if (expect_false (!SvIOK (sv)))
673     sv_2iv_flags (sv, 0);
674 root 1.3
675     U8 *lenb = cur++;
676    
677 root 1.5 if (SvIOK_notUV (sv))
678 root 1.3 {
679 root 1.5 IV iv = SvIVX (sv);
680    
681     if (expect_false (iv < 0))
682     {
683     // get two's complement bit pattern - works even on hypothetical non-2c machines
684     UV uv = iv;
685    
686     #if UVSIZE > 4
687     *cur = uv >> 56; cur += !!(~uv & 0xff80000000000000U);
688     *cur = uv >> 48; cur += !!(~uv & 0xffff800000000000U);
689     *cur = uv >> 40; cur += !!(~uv & 0xffffff8000000000U);
690     *cur = uv >> 32; cur += !!(~uv & 0xffffffff80000000U);
691     #endif
692     *cur = uv >> 24; cur += !!(~uv & 0xffffffffff800000U);
693     *cur = uv >> 16; cur += !!(~uv & 0xffffffffffff8000U);
694     *cur = uv >> 8; cur += !!(~uv & 0xffffffffffffff80U);
695     *cur = uv ; cur += 1;
696    
697     *lenb = cur - lenb - 1;
698 root 1.3
699 root 1.5 return;
700     }
701 root 1.3 }
702    
703 root 1.5 UV uv = SvUV (sv);
704 root 1.3
705 root 1.5 // prepend an extra 0 if the high bit is 1
706     *cur = 0; cur += !!(uv & ((UV)1 << (UVSIZE * 8 - 1)));
707 root 1.3
708 root 1.5 #if UVSIZE > 4
709     *cur = uv >> 56; cur += !!(uv & 0xff80000000000000U);
710     *cur = uv >> 48; cur += !!(uv & 0xffff800000000000U);
711     *cur = uv >> 40; cur += !!(uv & 0xffffff8000000000U);
712     *cur = uv >> 32; cur += !!(uv & 0xffffffff80000000U);
713     #endif
714     *cur = uv >> 24; cur += !!(uv & 0xffffffffff800000U);
715     *cur = uv >> 16; cur += !!(uv & 0xffffffffffff8000U);
716     *cur = uv >> 8; cur += !!(uv & 0xffffffffffffff80U);
717 root 1.3 *cur = uv ; cur += 1;
718    
719     *lenb = cur - lenb - 1;
720     }
721    
722     // we don't know the length yet, so we optimistically
723     // assume the length will need one octet later. if that
724     // turns out to be wrong, we memove as needed.
725     // mark the beginning
726     static STRLEN
727     len_fixup_mark ()
728     {
729     return cur++ - buf;
730     }
731    
732     // patch up the length
733     static void
734     len_fixup (STRLEN mark)
735     {
736     STRLEN reallen = (cur - buf) - mark - 1;
737     int lenlen = length_length (reallen);
738    
739     if (expect_false (lenlen > 1))
740     {
741     // bad luck, we have to shift the bytes to make room for the length
742     need (5);
743     memmove (buf + mark + lenlen, buf + mark + 1, reallen);
744     cur += lenlen - 1;
745     }
746    
747     put_length_at (reallen, buf + mark);
748     }
749    
750     static char *
751     read_uv (char *str, UV *uv)
752     {
753     UV r = 0;
754    
755     while (*str >= '0')
756     r = r * 10 + *str++ - '0';
757    
758     *uv = r;
759    
760     str += !!*str; // advance over any non-zero byte
761    
762     return str;
763     }
764    
765     static void
766 root 1.5 encode_oid (SV *oid, int relative)
767 root 1.3 {
768 root 1.5 STRLEN len;
769     char *ptr = SvPV (oid, len); // utf8 vs. bytes does not matter
770 root 1.3
771     // we need at most as many octets as the string form
772 root 1.5 need (len + 1);
773 root 1.3 STRLEN mark = len_fixup_mark ();
774    
775     UV w1, w2;
776    
777 root 1.5 if (!relative)
778     {
779     ptr = read_uv (ptr, &w1);
780     ptr = read_uv (ptr, &w2);
781 root 1.3
782 root 1.5 put_w_nocheck (w1 * 40 + w2);
783     }
784 root 1.3
785     while (*ptr)
786     {
787     ptr = read_uv (ptr, &w1);
788     put_w_nocheck (w1);
789     }
790    
791     len_fixup (mark);
792     }
793    
794 root 1.5 // check whether an SV is a BER tuple and returns its AV *
795 root 1.4 static AV *
796     ber_tuple (SV *tuple)
797 root 1.3 {
798 root 1.4 SV *rv;
799    
800     if (expect_false (!SvROK (tuple) || SvTYPE ((rv = SvRV (tuple))) != SVt_PVAV))
801 root 1.3 croak ("BER tuple must be array-reference");
802    
803 root 1.4 if (expect_false (SvRMAGICAL (rv)))
804     croak ("BER tuple must not be tied");
805 root 1.3
806 root 1.4 if (expect_false (AvFILL ((AV *)rv) != BER_ARRAYSIZE - 1))
807     croak ("BER tuple must contain exactly %d elements, not %d", BER_ARRAYSIZE, AvFILL ((AV *)rv) + 1);
808 root 1.3
809 root 1.4 return (AV *)rv;
810     }
811    
812     static void
813 root 1.7 encode_ucs (SV *data, int chrsize)
814     {
815     STRLEN uchars = sv_len_utf8 (data);
816     STRLEN len;;
817     char *ptr = SvPVutf8 (data, len);
818    
819     put_length (uchars * chrsize);
820    
821     while (uchars--)
822     {
823     STRLEN uclen;
824 root 1.10 UV uchr = utf8_to_uvchr_buf ((U8 *)ptr, (U8 *)ptr + len, &uclen);
825 root 1.7
826     ptr += uclen;
827     len -= uclen;
828    
829     if (chrsize == 4)
830     {
831     *cur++ = uchr >> 24;
832     *cur++ = uchr >> 16;
833     }
834    
835     *cur++ = uchr >> 8;
836     *cur++ = uchr;
837     }
838     }
839     static void
840 root 1.4 encode_ber (SV *tuple)
841     {
842     AV *av = ber_tuple (tuple);
843 root 1.3
844     int klass = SvIV (AvARRAY (av)[BER_CLASS]);
845     int tag = SvIV (AvARRAY (av)[BER_TAG]);
846     int constructed = SvIV (AvARRAY (av)[BER_CONSTRUCTED]) ? ASN_CONSTRUCTED : 0;
847     SV *data = AvARRAY (av)[BER_DATA];
848    
849     int identifier = (klass << ASN_CLASS_SHIFT) | constructed;
850    
851     if (expect_false (tag >= ASN_TAG_BER))
852     {
853     put_u8 (identifier | ASN_TAG_BER);
854     put_w (tag);
855     }
856     else
857     put_u8 (identifier | tag);
858    
859     if (constructed)
860     {
861     // we optimistically assume that only one length byte is needed
862     // and adjust later
863     need (1);
864     STRLEN mark = len_fixup_mark ();
865    
866     if (expect_false (!SvROK (data) || SvTYPE (SvRV (data)) != SVt_PVAV))
867     croak ("BER constructed data must be array-reference");
868    
869     AV *av = (AV *)SvRV (data);
870     int fill = AvFILL (av);
871    
872     if (expect_false (SvRMAGICAL (av)))
873     croak ("BER constructed data must not be tied");
874    
875 root 1.11 int i;
876     for (i = 0; i <= fill; ++i)
877 root 1.3 encode_ber (AvARRAY (av)[i]);
878    
879     len_fixup (mark);
880     }
881     else
882 root 1.5 switch (profile_lookup (cur_profile, klass, tag))
883 root 1.3 {
884 root 1.5 case BER_TYPE_NULL:
885 root 1.3 put_length (0);
886     break;
887    
888 root 1.5 case BER_TYPE_BOOL:
889     put_length (1);
890 root 1.7 *cur++ = SvTRUE (data) ? 0xff : 0x00;
891 root 1.3 break;
892    
893 root 1.5 case BER_TYPE_OID:
894     encode_oid (data, 0);
895 root 1.3 break;
896    
897 root 1.5 case BER_TYPE_RELOID:
898     encode_oid (data, 1);
899 root 1.3 break;
900    
901 root 1.5 case BER_TYPE_INT:
902     encode_int (data);
903     break;
904    
905     case BER_TYPE_BYTES:
906     {
907     STRLEN len;
908     const char *ptr = SvPVbyte (data, len);
909     encode_data (ptr, len);
910     }
911     break;
912    
913     case BER_TYPE_UTF8:
914     {
915     STRLEN len;
916     const char *ptr = SvPVutf8 (data, len);
917     encode_data (ptr, len);
918     }
919     break;
920    
921 root 1.6 case BER_TYPE_IPADDRESS:
922     {
923     U8 ip[4];
924     sscanf (SvPV_nolen (data), "%hhu.%hhu.%hhu.%hhu", ip + 0, ip + 1, ip + 2, ip + 3);
925     encode_data ((const char *)ip, sizeof (ip));
926     }
927     break;
928    
929 root 1.5 case BER_TYPE_UCS2:
930 root 1.7 encode_ucs (data, 2);
931     break;
932    
933 root 1.5 case BER_TYPE_UCS4:
934 root 1.7 encode_ucs (data, 4);
935     break;
936    
937     case BER_TYPE_REAL:
938 root 1.5 case BER_TYPE_CROAK:
939 root 1.3 default:
940 root 1.5 croak ("unconfigured/unsupported class/tag %d/%d", klass, tag);
941 root 1.3 }
942    
943     }
944    
945     /////////////////////////////////////////////////////////////////////////////
946    
947 root 1.1 MODULE = Convert::BER::XS PACKAGE = Convert::BER::XS
948    
949     PROTOTYPES: ENABLE
950    
951     BOOT:
952     {
953     HV *stash = gv_stashpv ("Convert::BER::XS", 1);
954    
955 root 1.5 profile_stash = gv_stashpv ("Convert::BER::XS::Profile", 1);
956    
957 root 1.1 static const struct {
958     const char *name;
959     IV iv;
960     } *civ, const_iv[] = {
961 root 1.5 #define const_iv(name) { # name, name },
962     const_iv (ASN_BOOLEAN)
963     const_iv (ASN_INTEGER32)
964     const_iv (ASN_BIT_STRING)
965     const_iv (ASN_OCTET_STRING)
966     const_iv (ASN_NULL)
967     const_iv (ASN_OBJECT_IDENTIFIER)
968     const_iv (ASN_OBJECT_DESCRIPTOR)
969     const_iv (ASN_OID)
970     const_iv (ASN_EXTERNAL)
971     const_iv (ASN_REAL)
972     const_iv (ASN_SEQUENCE)
973     const_iv (ASN_ENUMERATED)
974     const_iv (ASN_EMBEDDED_PDV)
975     const_iv (ASN_UTF8_STRING)
976     const_iv (ASN_RELATIVE_OID)
977     const_iv (ASN_SET)
978     const_iv (ASN_NUMERIC_STRING)
979     const_iv (ASN_PRINTABLE_STRING)
980     const_iv (ASN_TELETEX_STRING)
981     const_iv (ASN_T61_STRING)
982     const_iv (ASN_VIDEOTEX_STRING)
983     const_iv (ASN_IA5_STRING)
984     const_iv (ASN_ASCII_STRING)
985     const_iv (ASN_UTC_TIME)
986     const_iv (ASN_GENERALIZED_TIME)
987     const_iv (ASN_GRAPHIC_STRING)
988     const_iv (ASN_VISIBLE_STRING)
989     const_iv (ASN_ISO646_STRING)
990     const_iv (ASN_GENERAL_STRING)
991     const_iv (ASN_UNIVERSAL_STRING)
992     const_iv (ASN_CHARACTER_STRING)
993     const_iv (ASN_BMP_STRING)
994    
995     const_iv (ASN_UNIVERSAL)
996     const_iv (ASN_APPLICATION)
997     const_iv (ASN_CONTEXT)
998     const_iv (ASN_PRIVATE)
999    
1000     const_iv (BER_CLASS)
1001     const_iv (BER_TAG)
1002     const_iv (BER_CONSTRUCTED)
1003     const_iv (BER_DATA)
1004    
1005     const_iv (BER_TYPE_BYTES)
1006     const_iv (BER_TYPE_UTF8)
1007     const_iv (BER_TYPE_UCS2)
1008     const_iv (BER_TYPE_UCS4)
1009     const_iv (BER_TYPE_INT)
1010     const_iv (BER_TYPE_OID)
1011     const_iv (BER_TYPE_RELOID)
1012     const_iv (BER_TYPE_NULL)
1013     const_iv (BER_TYPE_BOOL)
1014     const_iv (BER_TYPE_REAL)
1015 root 1.6 const_iv (BER_TYPE_IPADDRESS)
1016 root 1.5 const_iv (BER_TYPE_CROAK)
1017    
1018     const_iv (SNMP_IPADDRESS)
1019     const_iv (SNMP_COUNTER32)
1020     const_iv (SNMP_UNSIGNED32)
1021     const_iv (SNMP_TIMETICKS)
1022     const_iv (SNMP_OPAQUE)
1023     const_iv (SNMP_COUNTER64)
1024 root 1.1 };
1025    
1026     for (civ = const_iv + sizeof (const_iv) / sizeof (const_iv [0]); civ > const_iv; civ--)
1027     newCONSTSUB (stash, (char *)civ[-1].name, newSViv (civ[-1].iv));
1028     }
1029    
1030     SV *
1031 root 1.5 ber_decode (SV *ber, SV *profile = &PL_sv_undef)
1032 root 1.1 CODE:
1033     {
1034 root 1.5 cur_profile = SvPROFILE (profile);
1035 root 1.3 STRLEN len;
1036 root 1.10 buf = (U8 *)SvPVbyte (ber, len);
1037 root 1.1 cur = buf;
1038 root 1.3 end = buf + len;
1039 root 1.1
1040 root 1.2 RETVAL = decode_ber ();
1041 root 1.1 }
1042     OUTPUT: RETVAL
1043    
1044     void
1045     ber_is (SV *tuple, SV *klass = &PL_sv_undef, SV *tag = &PL_sv_undef, SV *constructed = &PL_sv_undef, SV *data = &PL_sv_undef)
1046     PPCODE:
1047     {
1048     if (!SvOK (tuple))
1049     XSRETURN_NO;
1050    
1051     if (!SvROK (tuple) || SvTYPE (SvRV (tuple)) != SVt_PVAV)
1052 root 1.4 croak ("ber_is: tuple must be BER tuple (array-ref)");
1053 root 1.1
1054     AV *av = (AV *)SvRV (tuple);
1055    
1056     XPUSHs (
1057     (!SvOK (klass) || SvIV (AvARRAY (av)[BER_CLASS ]) == SvIV (klass))
1058     && (!SvOK (tag) || SvIV (AvARRAY (av)[BER_TAG ]) == SvIV (tag))
1059     && (!SvOK (constructed) || !SvIV (AvARRAY (av)[BER_CONSTRUCTED]) == !SvIV (constructed))
1060     && (!SvOK (data) || sv_eq (AvARRAY (av)[BER_DATA ], data))
1061 root 1.4 ? &PL_sv_yes : &PL_sv_undef);
1062 root 1.1 }
1063    
1064     void
1065     ber_is_seq (SV *tuple)
1066     PPCODE:
1067     {
1068     if (!SvOK (tuple))
1069     XSRETURN_UNDEF;
1070    
1071 root 1.4 AV *av = ber_tuple (tuple);
1072 root 1.1
1073     XPUSHs (
1074     SvIV (AvARRAY (av)[BER_CLASS ]) == ASN_UNIVERSAL
1075     && SvIV (AvARRAY (av)[BER_TAG ]) == ASN_SEQUENCE
1076     && SvIV (AvARRAY (av)[BER_CONSTRUCTED])
1077     ? AvARRAY (av)[BER_DATA] : &PL_sv_undef);
1078     }
1079    
1080     void
1081 root 1.4 ber_is_i32 (SV *tuple, SV *value = &PL_sv_undef)
1082 root 1.1 PPCODE:
1083     {
1084     if (!SvOK (tuple))
1085     XSRETURN_NO;
1086    
1087 root 1.4 AV *av = ber_tuple (tuple);
1088 root 1.1
1089 root 1.4 IV data = SvIV (AvARRAY (av)[BER_DATA]);
1090 root 1.1
1091     XPUSHs (
1092 root 1.4 SvIV (AvARRAY (av)[BER_CLASS ]) == ASN_UNIVERSAL
1093     && SvIV (AvARRAY (av)[BER_TAG ]) == ASN_INTEGER32
1094     && !SvIV (AvARRAY (av)[BER_CONSTRUCTED])
1095     && (!SvOK (value) || data == SvIV (value))
1096     ? sv_2mortal (data ? newSViv (data) : newSVpv ("0 but true", 0))
1097     : &PL_sv_undef);
1098 root 1.1 }
1099    
1100     void
1101 root 1.4 ber_is_oid (SV *tuple, SV *oid = &PL_sv_undef)
1102 root 1.1 PPCODE:
1103     {
1104     if (!SvOK (tuple))
1105     XSRETURN_NO;
1106    
1107 root 1.4 AV *av = ber_tuple (tuple);
1108 root 1.1
1109     XPUSHs (
1110     SvIV (AvARRAY (av)[BER_CLASS ]) == ASN_UNIVERSAL
1111     && SvIV (AvARRAY (av)[BER_TAG ]) == ASN_OBJECT_IDENTIFIER
1112     && !SvIV (AvARRAY (av)[BER_CONSTRUCTED])
1113 root 1.4 && (!SvOK (oid) || sv_eq (AvARRAY (av)[BER_DATA], oid))
1114     ? newSVsv (AvARRAY (av)[BER_DATA]) : &PL_sv_undef);
1115 root 1.1 }
1116    
1117 root 1.3 #############################################################################
1118    
1119     void
1120 root 1.5 ber_encode (SV *tuple, SV *profile = &PL_sv_undef)
1121 root 1.3 PPCODE:
1122     {
1123 root 1.5 cur_profile = SvPROFILE (profile);
1124 root 1.3 buf_sv = sv_2mortal (NEWSV (0, 256));
1125     SvPOK_only (buf_sv);
1126     set_buf (buf_sv);
1127    
1128     encode_ber (tuple);
1129    
1130     SvCUR_set (buf_sv, cur - buf);
1131     XPUSHs (buf_sv);
1132     }
1133    
1134 root 1.4 SV *
1135     ber_i32 (IV iv)
1136     CODE:
1137     {
1138     AV *av = newAV ();
1139     av_fill (av, BER_ARRAYSIZE - 1);
1140     AvARRAY (av)[BER_CLASS ] = newSVcacheint (ASN_UNIVERSAL);
1141     AvARRAY (av)[BER_TAG ] = newSVcacheint (ASN_INTEGER32);
1142     AvARRAY (av)[BER_CONSTRUCTED] = newSVcacheint (0);
1143     AvARRAY (av)[BER_DATA ] = newSViv (iv);
1144     RETVAL = newRV_noinc ((SV *)av);
1145     }
1146     OUTPUT: RETVAL
1147    
1148     # TODO: not arrayref, but elements?
1149     SV *
1150     ber_seq (SV *arrayref)
1151     CODE:
1152     {
1153     AV *av = newAV ();
1154     av_fill (av, BER_ARRAYSIZE - 1);
1155     AvARRAY (av)[BER_CLASS ] = newSVcacheint (ASN_UNIVERSAL);
1156     AvARRAY (av)[BER_TAG ] = newSVcacheint (ASN_SEQUENCE);
1157     AvARRAY (av)[BER_CONSTRUCTED] = newSVcacheint (1);
1158     AvARRAY (av)[BER_DATA ] = newSVsv (arrayref);
1159     RETVAL = newRV_noinc ((SV *)av);
1160     }
1161     OUTPUT: RETVAL
1162    
1163 root 1.5 MODULE = Convert::BER::XS PACKAGE = Convert::BER::XS::Profile
1164    
1165     SV *
1166     new (SV *klass)
1167     CODE:
1168     RETVAL = profile_new ();
1169     OUTPUT: RETVAL
1170    
1171 root 1.6 void
1172     set (SV *profile, int klass, int tag, int type)
1173     CODE:
1174     profile_set (SvPROFILE (profile), klass, tag, type);
1175    
1176     IV
1177     get (SV *profile, int klass, int tag)
1178     CODE:
1179     RETVAL = profile_lookup (SvPROFILE (profile), klass, tag);
1180     OUTPUT: RETVAL
1181    
1182     void
1183     _set_default (SV *profile)
1184     CODE:
1185     default_profile = SvPROFILE (profile);
1186    
1187