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