blob: a157d9b0993b96d518949cfdc24736e50a9fa90d [file] [log] [blame]
Lev Walkin41ba1f22004-09-14 12:46:35 +00001/*-
Lev Walkine9360e62013-03-28 00:21:57 -07002 * Copyright (c) 2004-2013 Lev Walkin <vlm@lionet.info>. All rights reserved.
Lev Walkin41ba1f22004-09-14 12:46:35 +00003 * Redistribution and modifications are permitted subject to BSD license.
4 */
Lev Walkine9360e62013-03-28 00:21:57 -07005#define _ISOC99_SOURCE /* For ilogb() and quiet NAN */
Lev Walkin1aea6982004-10-26 09:35:25 +00006#define _BSD_SOURCE /* To reintroduce finite(3) */
Lev Walkin73823e12013-03-28 00:24:48 -07007#if defined(__alpha)
Lev Walkin1aea6982004-10-26 09:35:25 +00008#include <sys/resource.h> /* For INFINITY */
Lev Walkin33700162004-10-26 09:03:31 +00009#endif
Lev Walkina9cc46e2004-09-22 16:06:28 +000010#include <asn_internal.h>
Lev Walkin41ba1f22004-09-14 12:46:35 +000011#include <stdlib.h> /* for strtod(3) */
12#include <math.h>
13#include <errno.h>
Lev Walkin33700162004-10-26 09:03:31 +000014#include <REAL.h>
Lev Walkin725883b2006-10-09 12:07:58 +000015#include <OCTET_STRING.h>
Lev Walkin41ba1f22004-09-14 12:46:35 +000016
17#undef INT_MAX
18#define INT_MAX ((int)(((unsigned int)-1) >> 1))
19
Lev Walkin1aea6982004-10-26 09:35:25 +000020#if !(defined(NAN) || defined(INFINITY))
Lev Walkin50b0f6c2006-10-16 12:01:36 +000021static volatile double real_zero GCC_NOTUSED = 0.0;
Lev Walkin1aea6982004-10-26 09:35:25 +000022#endif
Lev Walkinae1bce92004-09-27 22:18:34 +000023#ifndef NAN
Lev Walkinc51e7d62004-09-27 22:16:18 +000024#define NAN (real_zero/real_zero)
Lev Walkin40319a12004-09-14 13:40:42 +000025#endif
Lev Walkin1aea6982004-10-26 09:35:25 +000026#ifndef INFINITY
27#define INFINITY (1.0/real_zero)
28#endif
Lev Walkin40319a12004-09-14 13:40:42 +000029
Lev Walkindaeb2162014-01-13 23:08:35 -080030#ifdef isfinite
31#define _asn_isfinite(d) isfinite(d) /* ISO C99 */
32#else
33#define _asn_isfinite(d) finite(d) /* Deprecated on Mac OS X 10.9 */
34#endif
35
Lev Walkin41ba1f22004-09-14 12:46:35 +000036/*
37 * REAL basic type description.
38 */
Wim Lewis18c2ec92014-07-29 11:30:10 -070039static const ber_tlv_tag_t asn_DEF_REAL_tags[] = {
Lev Walkin41ba1f22004-09-14 12:46:35 +000040 (ASN_TAG_CLASS_UNIVERSAL | (9 << 2))
41};
Lev Walkin5e033762004-09-29 13:26:15 +000042asn_TYPE_descriptor_t asn_DEF_REAL = {
Lev Walkin41ba1f22004-09-14 12:46:35 +000043 "REAL",
Lev Walkindc06f6b2004-10-20 15:50:55 +000044 "REAL",
Lev Walkin8e8078a2004-09-26 13:10:40 +000045 ASN__PRIMITIVE_TYPE_free,
Lev Walkina9cc46e2004-09-22 16:06:28 +000046 REAL_print,
Lev Walkin41ba1f22004-09-14 12:46:35 +000047 asn_generic_no_constraint,
Lev Walkin8e8078a2004-09-26 13:10:40 +000048 ber_decode_primitive,
49 der_encode_primitive,
Lev Walkin5f560912004-10-21 13:37:57 +000050 REAL_decode_xer,
Lev Walkina9cc46e2004-09-22 16:06:28 +000051 REAL_encode_xer,
Lev Walkin725883b2006-10-09 12:07:58 +000052 REAL_decode_uper,
53 REAL_encode_uper,
Harald Welte0b57b082015-08-30 16:33:07 +020054 REAL_decode_aper,
55 REAL_encode_aper,
Lev Walkin41ba1f22004-09-14 12:46:35 +000056 0, /* Use generic outmost tag fetcher */
Lev Walkin5e033762004-09-29 13:26:15 +000057 asn_DEF_REAL_tags,
58 sizeof(asn_DEF_REAL_tags) / sizeof(asn_DEF_REAL_tags[0]),
59 asn_DEF_REAL_tags, /* Same as above */
60 sizeof(asn_DEF_REAL_tags) / sizeof(asn_DEF_REAL_tags[0]),
Lev Walkin59b176e2005-11-26 11:25:14 +000061 0, /* No PER visible constraints */
Lev Walkin41ba1f22004-09-14 12:46:35 +000062 0, 0, /* No members */
63 0 /* No specifics */
64};
65
Lev Walkin5f560912004-10-21 13:37:57 +000066typedef enum specialRealValue {
67 SRV__NOT_A_NUMBER,
68 SRV__MINUS_INFINITY,
69 SRV__PLUS_INFINITY
70} specialRealValue_e;
71static struct specialRealValue_s {
72 char *string;
Lev Walkin8471cec2004-10-21 14:02:19 +000073 size_t length;
Lev Walkin1aea6982004-10-26 09:35:25 +000074 long dv;
Lev Walkin5f560912004-10-21 13:37:57 +000075} specialRealValue[] = {
76#define SRV_SET(foo, val) { foo, sizeof(foo) - 1, val }
Lev Walkin1aea6982004-10-26 09:35:25 +000077 SRV_SET("<NOT-A-NUMBER/>", 0),
78 SRV_SET("<MINUS-INFINITY/>", -1),
79 SRV_SET("<PLUS-INFINITY/>", 1),
Lev Walkin5f560912004-10-21 13:37:57 +000080#undef SRV_SET
81};
82
Lev Walkina9cc46e2004-09-22 16:06:28 +000083ssize_t
84REAL__dump(double d, int canonical, asn_app_consume_bytes_f *cb, void *app_key) {
Lev Walkin92b35d22004-09-27 20:52:18 +000085 char local_buf[64];
Lev Walkina9cc46e2004-09-22 16:06:28 +000086 char *buf = local_buf;
87 ssize_t buflen = sizeof(local_buf);
Lev Walkin92b35d22004-09-27 20:52:18 +000088 const char *fmt = canonical?"%.15E":"%.15f";
Lev Walkina9cc46e2004-09-22 16:06:28 +000089 ssize_t ret;
90
Lev Walkin8e8078a2004-09-26 13:10:40 +000091 /*
92 * Check whether it is a special value.
93 */
Lev Walkinc51e7d62004-09-27 22:16:18 +000094 /* fpclassify(3) is not portable yet */
95 if(isnan(d)) {
Lev Walkin5f560912004-10-21 13:37:57 +000096 buf = specialRealValue[SRV__NOT_A_NUMBER].string;
97 buflen = specialRealValue[SRV__NOT_A_NUMBER].length;
Lev Walkinc51e7d62004-09-27 22:16:18 +000098 return (cb(buf, buflen, app_key) < 0) ? -1 : buflen;
Lev Walkindaeb2162014-01-13 23:08:35 -080099 } else if(!_asn_isfinite(d)) {
Lev Walkinc51e7d62004-09-27 22:16:18 +0000100 if(copysign(1.0, d) < 0.0) {
Lev Walkin5f560912004-10-21 13:37:57 +0000101 buf = specialRealValue[SRV__MINUS_INFINITY].string;
102 buflen = specialRealValue[SRV__MINUS_INFINITY].length;
Lev Walkinc51e7d62004-09-27 22:16:18 +0000103 } else {
Lev Walkin5f560912004-10-21 13:37:57 +0000104 buf = specialRealValue[SRV__PLUS_INFINITY].string;
105 buflen = specialRealValue[SRV__PLUS_INFINITY].length;
Lev Walkinc51e7d62004-09-27 22:16:18 +0000106 }
107 return (cb(buf, buflen, app_key) < 0) ? -1 : buflen;
108 } else if(ilogb(d) <= -INT_MAX) {
109 if(copysign(1.0, d) < 0.0) {
110 buf = "-0";
111 buflen = 2;
112 } else {
113 buf = "0";
114 buflen = 1;
Lev Walkin8e8078a2004-09-26 13:10:40 +0000115 }
116 return (cb(buf, buflen, app_key) < 0) ? -1 : buflen;
117 }
118
119 /*
120 * Use the libc's double printing, hopefully they got it right.
121 */
Lev Walkina9cc46e2004-09-22 16:06:28 +0000122 do {
123 ret = snprintf(buf, buflen, fmt, d);
124 if(ret < 0) {
125 buflen <<= 1;
126 } else if(ret >= buflen) {
127 buflen = ret + 1;
128 } else {
129 buflen = ret;
130 break;
131 }
Lev Walkin419f6752006-09-13 04:02:00 +0000132 if(buf != local_buf) FREEMEM(buf);
Lev Walkin8e8078a2004-09-26 13:10:40 +0000133 buf = (char *)MALLOC(buflen);
Lev Walkina9cc46e2004-09-22 16:06:28 +0000134 if(!buf) return -1;
135 } while(1);
136
Lev Walkina9cc46e2004-09-22 16:06:28 +0000137 if(canonical) {
Lev Walkin92b35d22004-09-27 20:52:18 +0000138 /*
139 * Transform the "[-]d.dddE+-dd" output into "[-]d.dddE[-]d"
Lev Walkin5f560912004-10-21 13:37:57 +0000140 * Check that snprintf() constructed the output correctly.
Lev Walkin92b35d22004-09-27 20:52:18 +0000141 */
Lev Walkin8ca13c82016-01-24 22:40:00 -0800142 char *dot;
Lev Walkina9cc46e2004-09-22 16:06:28 +0000143 char *end = buf + buflen;
Lev Walkin92b35d22004-09-27 20:52:18 +0000144 char *last_zero;
Lev Walkin8ca13c82016-01-24 22:40:00 -0800145 char *prev_zero;
146 char *s;
147
148 enum {
149 LZSTATE_NOTHING,
150 LZSTATE_SEEN_ZERO
151 } lz_state = LZSTATE_NOTHING;
Lev Walkina9cc46e2004-09-22 16:06:28 +0000152
Lev Walkin5f560912004-10-21 13:37:57 +0000153 dot = (buf[0] == 0x2d /* '-' */) ? (buf + 2) : (buf + 1);
Lev Walkina9cc46e2004-09-22 16:06:28 +0000154 if(*dot >= 0x30) {
Lev Walkin78d917d2012-01-07 15:29:08 -0800155 if(buf != local_buf) FREEMEM(buf);
Lev Walkina9cc46e2004-09-22 16:06:28 +0000156 errno = EINVAL;
157 return -1; /* Not a dot, really */
158 }
Lev Walkin92b35d22004-09-27 20:52:18 +0000159 *dot = 0x2e; /* Replace possible comma */
Lev Walkina9cc46e2004-09-22 16:06:28 +0000160
Lev Walkin8ca13c82016-01-24 22:40:00 -0800161 for(prev_zero = last_zero = s = dot + 2; s < end; s++) {
162 switch(*s) {
163 case 0x45: /* 'E' */
164 if(lz_state == LZSTATE_SEEN_ZERO)
165 last_zero = prev_zero;
166 break;
167 case 0x30: /* '0' */
168 if(lz_state == LZSTATE_NOTHING)
169 prev_zero = s;
170 lz_state = LZSTATE_SEEN_ZERO;
171 continue;
172 default:
173 lz_state = LZSTATE_NOTHING;
174 continue;
175 }
176 break;
177 }
178
179 if(s == end) {
Lev Walkin78d917d2012-01-07 15:29:08 -0800180 if(buf != local_buf) FREEMEM(buf);
Lev Walkina9cc46e2004-09-22 16:06:28 +0000181 errno = EINVAL;
182 return -1; /* No promised E */
183 }
Lev Walkin8ca13c82016-01-24 22:40:00 -0800184
185 assert(*s == 0x45);
186 {
187 char *E = s;
188 char *expptr = ++E;
189 char *s = expptr;
190 int sign;
191
192 if(*expptr == 0x2b /* '+' */) {
193 /* Skip the "+" */
194 buflen -= 1;
195 sign = 0;
196 } else {
197 sign = 1;
198 s++;
199 }
200 expptr++;
201 if(expptr > end) {
202 if(buf != local_buf) FREEMEM(buf);
203 errno = EINVAL;
204 return -1;
205 }
206 if(*expptr == 0x30) {
207 buflen--;
208 expptr++;
209 }
210 if(*last_zero == 0x30) {
211 *last_zero = 0x45; /* E */
212 buflen -= s - (last_zero + 1);
213 s = last_zero + 1;
214 if(sign) {
215 *s++ = 0x2d /* '-' */;
216 buflen++;
217 }
218 }
219 for(; expptr <= end; s++, expptr++)
220 *s = *expptr;
221 }
Lev Walkin92b35d22004-09-27 20:52:18 +0000222 } else {
223 /*
224 * Remove trailing zeros.
225 */
226 char *end = buf + buflen;
227 char *last_zero = end;
Lev Walkinf0b808d2005-04-25 21:08:25 +0000228 int stoplooking = 0;
Lev Walkin92b35d22004-09-27 20:52:18 +0000229 char *z;
230 for(z = end - 1; z > buf; z--) {
231 switch(*z) {
Lev Walkinf0b808d2005-04-25 21:08:25 +0000232 case 0x30:
233 if(!stoplooking)
234 last_zero = z;
235 continue;
Lev Walkin92b35d22004-09-27 20:52:18 +0000236 case 0x31: case 0x32: case 0x33: case 0x34:
237 case 0x35: case 0x36: case 0x37: case 0x38: case 0x39:
Lev Walkinf0b808d2005-04-25 21:08:25 +0000238 stoplooking = 1;
Lev Walkin92b35d22004-09-27 20:52:18 +0000239 continue;
240 default: /* Catch dot and other separators */
Lev Walkinf0b808d2005-04-25 21:08:25 +0000241 /*
242 * Replace possible comma (which may even
243 * be not a comma at all: locale-defined).
244 */
245 *z = 0x2e;
Lev Walkin92b35d22004-09-27 20:52:18 +0000246 if(last_zero == z + 1) { /* leave x.0 */
247 last_zero++;
248 }
249 buflen = last_zero - buf;
250 *last_zero = '\0';
251 break;
252 }
253 break;
254 }
Lev Walkina9cc46e2004-09-22 16:06:28 +0000255 }
256
257 ret = cb(buf, buflen, app_key);
Lev Walkin419f6752006-09-13 04:02:00 +0000258 if(buf != local_buf) FREEMEM(buf);
Lev Walkina9cc46e2004-09-22 16:06:28 +0000259 return (ret < 0) ? -1 : buflen;
260}
261
Lev Walkin41ba1f22004-09-14 12:46:35 +0000262int
Lev Walkin5e033762004-09-29 13:26:15 +0000263REAL_print(asn_TYPE_descriptor_t *td, const void *sptr, int ilevel,
Lev Walkin41ba1f22004-09-14 12:46:35 +0000264 asn_app_consume_bytes_f *cb, void *app_key) {
265 const REAL_t *st = (const REAL_t *)sptr;
Lev Walkin8e8078a2004-09-26 13:10:40 +0000266 ssize_t ret;
Lev Walkin41ba1f22004-09-14 12:46:35 +0000267 double d;
Lev Walkin41ba1f22004-09-14 12:46:35 +0000268
269 (void)td; /* Unused argument */
270 (void)ilevel; /* Unused argument */
271
Lev Walkina9cc46e2004-09-22 16:06:28 +0000272 if(!st || !st->buf)
Lev Walkin8e8078a2004-09-26 13:10:40 +0000273 ret = cb("<absent>", 8, app_key);
Lev Walkin5e033762004-09-29 13:26:15 +0000274 else if(asn_REAL2double(st, &d))
Lev Walkin8e8078a2004-09-26 13:10:40 +0000275 ret = cb("<error>", 7, app_key);
276 else
277 ret = REAL__dump(d, 0, cb, app_key);
Lev Walkin41ba1f22004-09-14 12:46:35 +0000278
Lev Walkin8e8078a2004-09-26 13:10:40 +0000279 return (ret < 0) ? -1 : 0;
Lev Walkina9cc46e2004-09-22 16:06:28 +0000280}
Lev Walkin41ba1f22004-09-14 12:46:35 +0000281
Lev Walkina9cc46e2004-09-22 16:06:28 +0000282asn_enc_rval_t
Lev Walkin5e033762004-09-29 13:26:15 +0000283REAL_encode_xer(asn_TYPE_descriptor_t *td, void *sptr,
Lev Walkina9cc46e2004-09-22 16:06:28 +0000284 int ilevel, enum xer_encoder_flags_e flags,
285 asn_app_consume_bytes_f *cb, void *app_key) {
286 REAL_t *st = (REAL_t *)sptr;
287 asn_enc_rval_t er;
288 double d;
289
290 (void)ilevel;
291
Lev Walkin5e033762004-09-29 13:26:15 +0000292 if(!st || !st->buf || asn_REAL2double(st, &d))
Lev Walkin7c1dc052016-03-14 03:08:15 -0700293 ASN__ENCODE_FAILED;
Lev Walkina9cc46e2004-09-22 16:06:28 +0000294
295 er.encoded = REAL__dump(d, flags & XER_F_CANONICAL, cb, app_key);
Lev Walkin7c1dc052016-03-14 03:08:15 -0700296 if(er.encoded < 0) ASN__ENCODE_FAILED;
Lev Walkina9cc46e2004-09-22 16:06:28 +0000297
Lev Walkin7c1dc052016-03-14 03:08:15 -0700298 ASN__ENCODED_OK(er);
Lev Walkin41ba1f22004-09-14 12:46:35 +0000299}
300
Lev Walkin5f560912004-10-21 13:37:57 +0000301
302/*
303 * Decode the chunk of XML text encoding REAL.
304 */
Lev Walkin0fab1a62005-03-09 22:19:25 +0000305static enum xer_pbd_rval
306REAL__xer_body_decode(asn_TYPE_descriptor_t *td, void *sptr, const void *chunk_buf, size_t chunk_size) {
Lev Walkin8471cec2004-10-21 14:02:19 +0000307 REAL_t *st = (REAL_t *)sptr;
Lev Walkin5f560912004-10-21 13:37:57 +0000308 double value;
Lev Walkin0fab1a62005-03-09 22:19:25 +0000309 const char *xerdata = (const char *)chunk_buf;
Lev Walkin5f560912004-10-21 13:37:57 +0000310 char *endptr = 0;
311 char *b;
312
Lev Walkine0b56e02005-02-25 12:10:27 +0000313 (void)td;
314
Lev Walkin0fab1a62005-03-09 22:19:25 +0000315 if(!chunk_size) return XPBD_BROKEN_ENCODING;
Lev Walkin5f560912004-10-21 13:37:57 +0000316
317 /*
318 * Decode an XMLSpecialRealValue: <MINUS-INFINITY>, etc.
319 */
320 if(xerdata[0] == 0x3c /* '<' */) {
321 size_t i;
322 for(i = 0; i < sizeof(specialRealValue)
323 / sizeof(specialRealValue[0]); i++) {
324 struct specialRealValue_s *srv = &specialRealValue[i];
Lev Walkin1aea6982004-10-26 09:35:25 +0000325 double dv;
326
Lev Walkin5f560912004-10-21 13:37:57 +0000327 if(srv->length != chunk_size
328 || memcmp(srv->string, chunk_buf, chunk_size))
329 continue;
330
Lev Walkin1aea6982004-10-26 09:35:25 +0000331 /*
332 * It could've been done using
333 * (double)srv->dv / real_zero,
334 * but it summons fp exception on some platforms.
335 */
336 switch(srv->dv) {
337 case -1: dv = - INFINITY; break;
338 case 0: dv = NAN; break;
339 case 1: dv = INFINITY; break;
Lev Walkin0fab1a62005-03-09 22:19:25 +0000340 default: return XPBD_SYSTEM_FAILURE;
Lev Walkin1aea6982004-10-26 09:35:25 +0000341 }
342
Lev Walkin0fab1a62005-03-09 22:19:25 +0000343 if(asn_double2REAL(st, dv))
344 return XPBD_SYSTEM_FAILURE;
Lev Walkin5f560912004-10-21 13:37:57 +0000345
Lev Walkin0fab1a62005-03-09 22:19:25 +0000346 return XPBD_BODY_CONSUMED;
Lev Walkin5f560912004-10-21 13:37:57 +0000347 }
348 ASN_DEBUG("Unknown XMLSpecialRealValue");
Lev Walkin0fab1a62005-03-09 22:19:25 +0000349 return XPBD_BROKEN_ENCODING;
Lev Walkin5f560912004-10-21 13:37:57 +0000350 }
351
352 /*
353 * Copy chunk into the nul-terminated string, and run strtod.
354 */
Lev Walkin8471cec2004-10-21 14:02:19 +0000355 b = (char *)MALLOC(chunk_size + 1);
Lev Walkin0fab1a62005-03-09 22:19:25 +0000356 if(!b) return XPBD_SYSTEM_FAILURE;
Lev Walkin5f560912004-10-21 13:37:57 +0000357 memcpy(b, chunk_buf, chunk_size);
Lev Walkin8471cec2004-10-21 14:02:19 +0000358 b[chunk_size] = 0; /* nul-terminate */
Lev Walkin5f560912004-10-21 13:37:57 +0000359
360 value = strtod(b, &endptr);
Lev Walkin419f6752006-09-13 04:02:00 +0000361 FREEMEM(b);
Lev Walkin0fab1a62005-03-09 22:19:25 +0000362 if(endptr == b) return XPBD_BROKEN_ENCODING;
Lev Walkin5f560912004-10-21 13:37:57 +0000363
364 if(asn_double2REAL(st, value))
Lev Walkin0fab1a62005-03-09 22:19:25 +0000365 return XPBD_SYSTEM_FAILURE;
Lev Walkin5f560912004-10-21 13:37:57 +0000366
Lev Walkin0fab1a62005-03-09 22:19:25 +0000367 return XPBD_BODY_CONSUMED;
Lev Walkin5f560912004-10-21 13:37:57 +0000368}
369
370asn_dec_rval_t
371REAL_decode_xer(asn_codec_ctx_t *opt_codec_ctx,
372 asn_TYPE_descriptor_t *td, void **sptr, const char *opt_mname,
Lev Walkin8c3b8542005-03-10 18:52:02 +0000373 const void *buf_ptr, size_t size) {
Lev Walkin5f560912004-10-21 13:37:57 +0000374
375 return xer_decode_primitive(opt_codec_ctx, td,
Lev Walkin8471cec2004-10-21 14:02:19 +0000376 sptr, sizeof(REAL_t), opt_mname,
Lev Walkin5f560912004-10-21 13:37:57 +0000377 buf_ptr, size, REAL__xer_body_decode);
378}
379
Lev Walkin725883b2006-10-09 12:07:58 +0000380asn_dec_rval_t
381REAL_decode_uper(asn_codec_ctx_t *opt_codec_ctx,
382 asn_TYPE_descriptor_t *td, asn_per_constraints_t *constraints,
383 void **sptr, asn_per_data_t *pd) {
384 (void)constraints; /* No PER visible constraints */
385 return OCTET_STRING_decode_uper(opt_codec_ctx, td, 0, sptr, pd);
386}
387
388asn_enc_rval_t
389REAL_encode_uper(asn_TYPE_descriptor_t *td,
390 asn_per_constraints_t *constraints, void *sptr, asn_per_outp_t *po) {
391 (void)constraints; /* No PER visible constraints */
392 return OCTET_STRING_encode_uper(td, 0, sptr, po);
393}
Lev Walkin5f560912004-10-21 13:37:57 +0000394
Harald Welte0b57b082015-08-30 16:33:07 +0200395asn_dec_rval_t
396REAL_decode_aper(asn_codec_ctx_t *opt_codec_ctx,
397 asn_TYPE_descriptor_t *td, asn_per_constraints_t *constraints,
398 void **sptr, asn_per_data_t *pd) {
399 (void)constraints; /* No PER visible constraints */
400 return OCTET_STRING_decode_aper(opt_codec_ctx, td, 0, sptr, pd);
401}
402
403asn_enc_rval_t
404REAL_encode_aper(asn_TYPE_descriptor_t *td,
405 asn_per_constraints_t *constraints, void *sptr, asn_per_outp_t *po) {
406 (void)constraints; /* No PER visible constraints */
407 return OCTET_STRING_encode_aper(td, 0, sptr, po);
408}
409
Lev Walkin41ba1f22004-09-14 12:46:35 +0000410int
Lev Walkin5e033762004-09-29 13:26:15 +0000411asn_REAL2double(const REAL_t *st, double *dbl_value) {
Lev Walkina9cc46e2004-09-22 16:06:28 +0000412 unsigned int octv;
Lev Walkin41ba1f22004-09-14 12:46:35 +0000413
414 if(!st || !st->buf) {
415 errno = EINVAL;
416 return -1;
417 }
418
419 if(st->size == 0) {
420 *dbl_value = 0;
421 return 0;
422 }
423
424 octv = st->buf[0]; /* unsigned byte */
425
426 switch(octv & 0xC0) {
Lev Walkin5fda7d52012-01-09 03:20:19 -0800427 case 0x40: /* X.690: 8.5.6 a) => 8.5.9 */
Lev Walkin41ba1f22004-09-14 12:46:35 +0000428 /* "SpecialRealValue" */
429
430 /* Be liberal in what you accept...
Lev Walkin749916f2012-01-07 17:03:39 -0800431 * http://en.wikipedia.org/wiki/Robustness_principle
Lev Walkin41ba1f22004-09-14 12:46:35 +0000432 if(st->size != 1) ...
433 */
434
435 switch(st->buf[0]) {
436 case 0x40: /* 01000000: PLUS-INFINITY */
Lev Walkin1aea6982004-10-26 09:35:25 +0000437 *dbl_value = INFINITY;
Lev Walkin41ba1f22004-09-14 12:46:35 +0000438 return 0;
439 case 0x41: /* 01000001: MINUS-INFINITY */
Lev Walkin1aea6982004-10-26 09:35:25 +0000440 *dbl_value = - INFINITY;
Lev Walkin41ba1f22004-09-14 12:46:35 +0000441 return 0;
Lev Walkin41ba1f22004-09-14 12:46:35 +0000442 case 0x42: /* 01000010: NOT-A-NUMBER */
443 *dbl_value = NAN;
444 return 0;
445 case 0x43: /* 01000011: minus zero */
Lev Walkin2a789d92004-09-27 21:36:59 +0000446 *dbl_value = -0.0;
Lev Walkin41ba1f22004-09-14 12:46:35 +0000447 return 0;
448 }
449
450 errno = EINVAL;
451 return -1;
Lev Walkin0959ffb2011-06-25 15:48:52 -0700452 case 0x00: { /* X.690: 8.5.7 */
Lev Walkin41ba1f22004-09-14 12:46:35 +0000453 /*
Lev Walkin5fda7d52012-01-09 03:20:19 -0800454 * Decimal. NR{1,2,3} format from ISO 6093.
455 * NR1: [ ]*[+-]?[0-9]+
456 * NR2: [ ]*[+-]?([0-9]+\.[0-9]*|[0-9]*\.[0-9]+)
457 * NR3: [ ]*[+-]?([0-9]+\.[0-9]*|[0-9]*\.[0-9]+)[Ee][+-]?[0-9]+
Lev Walkin41ba1f22004-09-14 12:46:35 +0000458 */
459 double d;
Lev Walkin5fda7d52012-01-09 03:20:19 -0800460 char *buf;
461 char *endptr;
462 int used_malloc = 0;
Lev Walkin41ba1f22004-09-14 12:46:35 +0000463
Lev Walkin5fda7d52012-01-09 03:20:19 -0800464 if(octv == 0 || (octv & 0x3C)) {
Lev Walkin0959ffb2011-06-25 15:48:52 -0700465 /* Remaining values of bits 6 to 1 are Reserved. */
466 errno = EINVAL;
467 return -1;
468 }
Lev Walkin41ba1f22004-09-14 12:46:35 +0000469
Lev Walkin5fda7d52012-01-09 03:20:19 -0800470
471 /* 1. By contract, an input buffer should be null-terminated.
472 * OCTET STRING decoder ensures that, as is asn_double2REAL().
473 * 2. ISO 6093 specifies COMMA as a possible decimal separator.
474 * However, strtod() can't always deal with COMMA.
475 * So her we fix both by reallocating, copying and fixing.
476 */
477 if(st->buf[st->size] || memchr(st->buf, ',', st->size)) {
478 uint8_t *p, *end;
479 char *b;
480 if(st->size > 100) {
481 /* Avoid malicious stack overflow in alloca() */
482 buf = (char *)MALLOC(st->size);
483 if(!buf) return -1;
484 used_malloc = 1;
485 } else {
486 buf = alloca(st->size);
487 }
488 b = buf;
489 /* Copy without the first byte and with 0-termination */
490 for(p = st->buf + 1, end = st->buf + st->size;
491 p < end; b++, p++)
492 *b = (*p == ',') ? '.' : *p;
493 *b = '\0';
494 } else {
495 buf = (char *)&st->buf[1];
496 }
497
498 endptr = buf;
499 d = strtod(buf, &endptr);
500 if(*endptr != '\0') {
501 /* Format is not consistent with ISO 6093 */
502 if(used_malloc) FREEMEM(buf);
Lev Walkin0959ffb2011-06-25 15:48:52 -0700503 errno = EINVAL;
504 return -1;
505 }
Lev Walkin5fda7d52012-01-09 03:20:19 -0800506 if(used_malloc) FREEMEM(buf);
Lev Walkindaeb2162014-01-13 23:08:35 -0800507 if(_asn_isfinite(d)) {
Lev Walkin41ba1f22004-09-14 12:46:35 +0000508 *dbl_value = d;
509 return 0;
510 } else {
511 errno = ERANGE;
Lev Walkin0959ffb2011-06-25 15:48:52 -0700512 return -1;
Lev Walkin41ba1f22004-09-14 12:46:35 +0000513 }
514 }
515 }
516
517 /*
518 * Binary representation.
519 */
520 {
521 double m;
522 int expval; /* exponent value */
523 unsigned int elen; /* exponent value length, in octets */
524 unsigned int scaleF;
525 unsigned int baseF;
526 uint8_t *ptr;
527 uint8_t *end;
528 int sign;
529
530 switch((octv & 0x30) >> 4) {
531 case 0x00: baseF = 1; break; /* base 2 */
532 case 0x01: baseF = 3; break; /* base 8 */
533 case 0x02: baseF = 4; break; /* base 16 */
534 default:
535 /* Reserved field, can't parse now. */
536 errno = EINVAL;
537 return -1;
538 }
539
540 sign = (octv & 0x40); /* bit 7 */
541 scaleF = (octv & 0x0C) >> 2; /* bits 4 to 3 */
542
Lev Walkina9cc46e2004-09-22 16:06:28 +0000543 if(st->size <= (int)(1 + (octv & 0x03))) {
Lev Walkin41ba1f22004-09-14 12:46:35 +0000544 errno = EINVAL;
545 return -1;
546 }
547
Lev Walkine78753d2007-06-23 17:02:00 +0000548 elen = (octv & 0x03); /* bits 2 to 1; 8.5.6.4 */
549 if(elen == 0x03) { /* bits 2 to 1 = 11; 8.5.6.4, case d) */
Lev Walkin41ba1f22004-09-14 12:46:35 +0000550 elen = st->buf[1]; /* unsigned binary number */
Lev Walkina9cc46e2004-09-22 16:06:28 +0000551 if(elen == 0 || st->size <= (int)(2 + elen)) {
Lev Walkin41ba1f22004-09-14 12:46:35 +0000552 errno = EINVAL;
553 return -1;
554 }
Lev Walkine78753d2007-06-23 17:02:00 +0000555 /* FIXME: verify constraints of case d) */
Lev Walkin41ba1f22004-09-14 12:46:35 +0000556 ptr = &st->buf[2];
557 } else {
Lev Walkin41ba1f22004-09-14 12:46:35 +0000558 ptr = &st->buf[1];
559 }
560
561 /* Fetch the multibyte exponent */
562 expval = (int)(*(int8_t *)ptr);
563 end = ptr + elen + 1;
564 for(ptr++; ptr < end; ptr++)
565 expval = (expval * 256) + *ptr;
566
567 m = 0.0; /* Initial mantissa value */
568
569 /* Okay, the exponent is here. Now, what about mantissa? */
570 end = st->buf + st->size;
Lev Walkin5fda7d52012-01-09 03:20:19 -0800571 for(; ptr < end; ptr++)
572 m = ldexp(m, 8) + *ptr;
Lev Walkin41ba1f22004-09-14 12:46:35 +0000573
Lev Walkin5f560912004-10-21 13:37:57 +0000574 if(0)
Lev Walkin5fda7d52012-01-09 03:20:19 -0800575 ASN_DEBUG("m=%.10f, scF=%d, bF=%d, expval=%d, ldexp()=%f, ldexp()=%f\n",
Lev Walkin41ba1f22004-09-14 12:46:35 +0000576 m, scaleF, baseF, expval,
577 ldexp(m, expval * baseF + scaleF),
Lev Walkin77aa90f2005-04-28 22:56:36 +0000578 ldexp(m, scaleF) * pow(pow(2, baseF), expval)
Lev Walkin41ba1f22004-09-14 12:46:35 +0000579 );
580
581 /*
582 * (S * N * 2^F) * B^E
583 * Essentially:
Lev Walkin77aa90f2005-04-28 22:56:36 +0000584 m = ldexp(m, scaleF) * pow(pow(2, base), expval);
Lev Walkin41ba1f22004-09-14 12:46:35 +0000585 */
586 m = ldexp(m, expval * baseF + scaleF);
Lev Walkindaeb2162014-01-13 23:08:35 -0800587 if(_asn_isfinite(m)) {
Lev Walkin41ba1f22004-09-14 12:46:35 +0000588 *dbl_value = sign ? -m : m;
589 } else {
590 errno = ERANGE;
591 return -1;
592 }
593
594 } /* if(binary_format) */
595
596 return 0;
597}
598
599/*
600 * Assume IEEE 754 floating point: standard 64 bit double.
601 * [1 bit sign] [11 bits exponent] [52 bits mantissa]
602 */
603int
Lev Walkin5e033762004-09-29 13:26:15 +0000604asn_double2REAL(REAL_t *st, double dbl_value) {
Lev Walkin41ba1f22004-09-14 12:46:35 +0000605#ifdef WORDS_BIGENDIAN /* Known to be big-endian */
606 int littleEndian = 0;
607#else /* need to test: have no explicit information */
608 unsigned int LE = 1;
609 int littleEndian = *(unsigned char *)&LE;
610#endif
611 uint8_t buf[16]; /* More than enough for 8-byte dbl_value */
612 uint8_t dscr[sizeof(dbl_value)]; /* double value scratch pad */
613 /* Assertion guards: won't even compile, if unexpected double size */
Lev Walkin50b0f6c2006-10-16 12:01:36 +0000614 char assertion_buffer1[9 - sizeof(dbl_value)] GCC_NOTUSED;
615 char assertion_buffer2[sizeof(dbl_value) - 7] GCC_NOTUSED;
Lev Walkin41ba1f22004-09-14 12:46:35 +0000616 uint8_t *ptr = buf;
617 uint8_t *mstop; /* Last byte of mantissa */
618 unsigned int mval; /* Value of the last byte of mantissa */
619 unsigned int bmsign; /* binary mask with sign */
620 unsigned int buflen;
621 unsigned int accum;
622 int expval;
623
624 if(!st) {
625 errno = EINVAL;
626 return -1;
627 }
628
Lev Walkin057fb732004-09-14 13:58:10 +0000629 /*
630 * ilogb(+-0) returns -INT_MAX or INT_MIN (platform-dependent)
Lev Walkin2f505022005-07-01 08:28:18 +0000631 * ilogb(+-inf) returns INT_MAX, logb(+-inf) returns +inf
Lev Walkin2a789d92004-09-27 21:36:59 +0000632 * ilogb(NaN) returns INT_MIN or INT_MAX (platform-dependent)
Lev Walkin057fb732004-09-14 13:58:10 +0000633 */
Lev Walkin41ba1f22004-09-14 12:46:35 +0000634 expval = ilogb(dbl_value);
Lev Walkin2a789d92004-09-27 21:36:59 +0000635 if(expval <= -INT_MAX /* Also catches +-0 and maybe isnan() */
636 || expval == INT_MAX /* catches isfin() and maybe isnan() */
Lev Walkin41ba1f22004-09-14 12:46:35 +0000637 ) {
638 if(!st->buf || st->size < 2) {
Lev Walkin8e8078a2004-09-26 13:10:40 +0000639 ptr = (uint8_t *)MALLOC(2);
Lev Walkin41ba1f22004-09-14 12:46:35 +0000640 if(!ptr) return -1;
641 st->buf = ptr;
642 }
643 /* fpclassify(3) is not portable yet */
Lev Walkin2a789d92004-09-27 21:36:59 +0000644 if(isnan(dbl_value)) {
645 st->buf[0] = 0x42; /* NaN */
646 st->buf[1] = 0;
647 st->size = 1;
Lev Walkindaeb2162014-01-13 23:08:35 -0800648 } else if(!_asn_isfinite(dbl_value)) {
Lev Walkin7e03db92004-09-14 13:50:21 +0000649 if(copysign(1.0, dbl_value) < 0.0) {
Lev Walkin41ba1f22004-09-14 12:46:35 +0000650 st->buf[0] = 0x41; /* MINUS-INFINITY */
651 } else {
652 st->buf[0] = 0x40; /* PLUS-INFINITY */
653 }
654 st->buf[1] = 0;
655 st->size = 1;
Lev Walkinc51e7d62004-09-27 22:16:18 +0000656 } else {
Lev Walkin5fe72e92012-01-07 17:00:29 -0800657 if(copysign(1.0, dbl_value) >= 0.0) {
Lev Walkinc51e7d62004-09-27 22:16:18 +0000658 /* no content octets: positive zero */
659 st->buf[0] = 0; /* JIC */
660 st->size = 0;
Lev Walkin5fe72e92012-01-07 17:00:29 -0800661 } else {
662 /* Negative zero. #8.5.3, 8.5.9 */
663 st->buf[0] = 0x43;
664 st->size = 1;
Lev Walkinc51e7d62004-09-27 22:16:18 +0000665 }
Lev Walkin41ba1f22004-09-14 12:46:35 +0000666 }
667 return 0;
668 }
669
670 if(littleEndian) {
671 uint8_t *s = ((uint8_t *)&dbl_value) + sizeof(dbl_value) - 2;
Lev Walkin057fb732004-09-14 13:58:10 +0000672 uint8_t *start = ((uint8_t *)&dbl_value);
Lev Walkin41ba1f22004-09-14 12:46:35 +0000673 uint8_t *d;
674
675 bmsign = 0x80 | ((s[1] >> 1) & 0x40); /* binary mask & - */
Lev Walkin057fb732004-09-14 13:58:10 +0000676 for(mstop = d = dscr; s >= start; d++, s--) {
Lev Walkin41ba1f22004-09-14 12:46:35 +0000677 *d = *s;
678 if(*d) mstop = d;
679 }
680 } else {
681 uint8_t *s = ((uint8_t *)&dbl_value) + 1;
682 uint8_t *end = ((uint8_t *)&dbl_value) + sizeof(double);
683 uint8_t *d;
684
685 bmsign = 0x80 | ((s[-1] >> 1) & 0x40); /* binary mask & - */
686 for(mstop = d = dscr; s < end; d++, s++) {
687 *d = *s;
688 if(*d) mstop = d;
689 }
690 }
691
692 /* Remove parts of the exponent, leave mantissa and explicit 1. */
693 dscr[0] = 0x10 | (dscr[0] & 0x0f);
694
695 /* Adjust exponent in a very unobvious way */
696 expval -= 8 * ((mstop - dscr) + 1) - 4;
697
698 /* This loop ensures DER conformance by forcing mantissa odd: 11.3.1 */
699 mval = *mstop;
700 if(mval && !(mval & 1)) {
701 unsigned int shift_count = 1;
702 unsigned int ishift;
703 uint8_t *mptr;
704
705 /*
706 * Figure out what needs to be done to make mantissa odd.
707 */
708 if(!(mval & 0x0f)) /* Speed-up a little */
709 shift_count = 4;
710 while(((mval >> shift_count) & 1) == 0)
711 shift_count++;
712
713 ishift = 8 - shift_count;
714 accum = 0;
715
716 /* Go over the buffer, shifting it shift_count bits right. */
717 for(mptr = dscr; mptr <= mstop; mptr++) {
718 mval = *mptr;
719 *mptr = accum | (mval >> shift_count);
720 accum = mval << ishift;
721 }
722
Lev Walkinb89b3402012-01-09 18:26:30 -0800723 /* Adjust exponent appropriately. */
Lev Walkin41ba1f22004-09-14 12:46:35 +0000724 expval += shift_count;
725 }
726
727 if(expval < 0) {
728 if((expval >> 7) == -1) {
729 *ptr++ = bmsign | 0x00;
730 *ptr++ = expval;
731 } else if((expval >> 15) == -1) {
732 *ptr++ = bmsign | 0x01;
733 *ptr++ = expval >> 8;
734 *ptr++ = expval;
735 } else {
Lev Walkin41ba1f22004-09-14 12:46:35 +0000736 *ptr++ = bmsign | 0x02;
737 *ptr++ = expval >> 16;
738 *ptr++ = expval >> 8;
739 *ptr++ = expval;
740 }
741 } else if(expval <= 0x7f) {
742 *ptr++ = bmsign | 0x00;
743 *ptr++ = expval;
744 } else if(expval <= 0x7fff) {
745 *ptr++ = bmsign | 0x01;
746 *ptr++ = expval >> 8;
747 *ptr++ = expval;
748 } else {
749 assert(expval <= 0x7fffff);
750 *ptr++ = bmsign | 0x02;
751 *ptr++ = expval >> 16;
752 *ptr++ = expval >> 8;
753 *ptr++ = expval;
754 }
755
756 buflen = (mstop - dscr) + 1;
757 memcpy(ptr, dscr, buflen);
758 ptr += buflen;
759 buflen = ptr - buf;
760
Lev Walkinc17d90f2005-01-17 14:32:45 +0000761 ptr = (uint8_t *)MALLOC(buflen + 1);
Lev Walkin41ba1f22004-09-14 12:46:35 +0000762 if(!ptr) return -1;
763
764 memcpy(ptr, buf, buflen);
765 buf[buflen] = 0; /* JIC */
766
767 if(st->buf) FREEMEM(st->buf);
768 st->buf = ptr;
769 st->size = buflen;
770
771 return 0;
772}