blob: 2993b7cede2ee4c2d5ccab3cf9000309857d3ba8 [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 */
Vasil Velichkovadf65942016-08-01 16:52:02 +03006#ifndef _BSD_SOURCE
Lev Walkin1aea6982004-10-26 09:35:25 +00007#define _BSD_SOURCE /* To reintroduce finite(3) */
Vasil Velichkovadf65942016-08-01 16:52:02 +03008#endif
Lev Walkin73823e12013-03-28 00:24:48 -07009#if defined(__alpha)
Lev Walkin1aea6982004-10-26 09:35:25 +000010#include <sys/resource.h> /* For INFINITY */
Lev Walkin33700162004-10-26 09:03:31 +000011#endif
Lev Walkina9cc46e2004-09-22 16:06:28 +000012#include <asn_internal.h>
Lev Walkin41ba1f22004-09-14 12:46:35 +000013#include <stdlib.h> /* for strtod(3) */
14#include <math.h>
15#include <errno.h>
Lev Walkin33700162004-10-26 09:03:31 +000016#include <REAL.h>
Lev Walkin725883b2006-10-09 12:07:58 +000017#include <OCTET_STRING.h>
Lev Walkin41ba1f22004-09-14 12:46:35 +000018
19#undef INT_MAX
20#define INT_MAX ((int)(((unsigned int)-1) >> 1))
21
Lev Walkin1aea6982004-10-26 09:35:25 +000022#if !(defined(NAN) || defined(INFINITY))
Lev Walkin50b0f6c2006-10-16 12:01:36 +000023static volatile double real_zero GCC_NOTUSED = 0.0;
Lev Walkin1aea6982004-10-26 09:35:25 +000024#endif
Lev Walkinae1bce92004-09-27 22:18:34 +000025#ifndef NAN
Lev Walkinc51e7d62004-09-27 22:16:18 +000026#define NAN (real_zero/real_zero)
Lev Walkin40319a12004-09-14 13:40:42 +000027#endif
Lev Walkin1aea6982004-10-26 09:35:25 +000028#ifndef INFINITY
29#define INFINITY (1.0/real_zero)
30#endif
Lev Walkin40319a12004-09-14 13:40:42 +000031
Lev Walkindaeb2162014-01-13 23:08:35 -080032#ifdef isfinite
33#define _asn_isfinite(d) isfinite(d) /* ISO C99 */
34#else
35#define _asn_isfinite(d) finite(d) /* Deprecated on Mac OS X 10.9 */
36#endif
37
Lev Walkin41ba1f22004-09-14 12:46:35 +000038/*
39 * REAL basic type description.
40 */
Wim Lewis18c2ec92014-07-29 11:30:10 -070041static const ber_tlv_tag_t asn_DEF_REAL_tags[] = {
Lev Walkin41ba1f22004-09-14 12:46:35 +000042 (ASN_TAG_CLASS_UNIVERSAL | (9 << 2))
43};
Lev Walkin5e033762004-09-29 13:26:15 +000044asn_TYPE_descriptor_t asn_DEF_REAL = {
Lev Walkin41ba1f22004-09-14 12:46:35 +000045 "REAL",
Lev Walkindc06f6b2004-10-20 15:50:55 +000046 "REAL",
Lev Walkin8e8078a2004-09-26 13:10:40 +000047 ASN__PRIMITIVE_TYPE_free,
Lev Walkina9cc46e2004-09-22 16:06:28 +000048 REAL_print,
Lev Walkin41ba1f22004-09-14 12:46:35 +000049 asn_generic_no_constraint,
Lev Walkin8e8078a2004-09-26 13:10:40 +000050 ber_decode_primitive,
51 der_encode_primitive,
Lev Walkin5f560912004-10-21 13:37:57 +000052 REAL_decode_xer,
Lev Walkina9cc46e2004-09-22 16:06:28 +000053 REAL_encode_xer,
Lev Walkin80334ed2017-07-06 07:28:21 -070054#ifdef ASN_DISABLE_PER_SUPPORT
55 0,
56 0,
57#else
Lev Walkin725883b2006-10-09 12:07:58 +000058 REAL_decode_uper,
59 REAL_encode_uper,
Lev Walkin80334ed2017-07-06 07:28:21 -070060#endif /* ASN_DISABLE_PER_SUPPORT */
Lev Walkincc159472017-07-06 08:26:36 -070061#ifdef ASN_DISABLE_OER_SUPPORT
62 0,
63 0,
64#else
65 0,
66 0,
67#endif /* ASN_DISABLE_OER_SUPPORT */
Lev Walkin41ba1f22004-09-14 12:46:35 +000068 0, /* Use generic outmost tag fetcher */
Lev Walkin5e033762004-09-29 13:26:15 +000069 asn_DEF_REAL_tags,
70 sizeof(asn_DEF_REAL_tags) / sizeof(asn_DEF_REAL_tags[0]),
71 asn_DEF_REAL_tags, /* Same as above */
72 sizeof(asn_DEF_REAL_tags) / sizeof(asn_DEF_REAL_tags[0]),
Lev Walkin59b176e2005-11-26 11:25:14 +000073 0, /* No PER visible constraints */
Lev Walkin41ba1f22004-09-14 12:46:35 +000074 0, 0, /* No members */
75 0 /* No specifics */
76};
77
Lev Walkin5f560912004-10-21 13:37:57 +000078typedef enum specialRealValue {
79 SRV__NOT_A_NUMBER,
80 SRV__MINUS_INFINITY,
81 SRV__PLUS_INFINITY
82} specialRealValue_e;
83static struct specialRealValue_s {
84 char *string;
Lev Walkin8471cec2004-10-21 14:02:19 +000085 size_t length;
Lev Walkin1aea6982004-10-26 09:35:25 +000086 long dv;
Lev Walkin5f560912004-10-21 13:37:57 +000087} specialRealValue[] = {
88#define SRV_SET(foo, val) { foo, sizeof(foo) - 1, val }
Lev Walkin1aea6982004-10-26 09:35:25 +000089 SRV_SET("<NOT-A-NUMBER/>", 0),
90 SRV_SET("<MINUS-INFINITY/>", -1),
91 SRV_SET("<PLUS-INFINITY/>", 1),
Lev Walkin5f560912004-10-21 13:37:57 +000092#undef SRV_SET
93};
94
Lev Walkina9cc46e2004-09-22 16:06:28 +000095ssize_t
96REAL__dump(double d, int canonical, asn_app_consume_bytes_f *cb, void *app_key) {
Lev Walkin92b35d22004-09-27 20:52:18 +000097 char local_buf[64];
Lev Walkina9cc46e2004-09-22 16:06:28 +000098 char *buf = local_buf;
99 ssize_t buflen = sizeof(local_buf);
Lev Walkin92b35d22004-09-27 20:52:18 +0000100 const char *fmt = canonical?"%.15E":"%.15f";
Lev Walkina9cc46e2004-09-22 16:06:28 +0000101 ssize_t ret;
102
Lev Walkin8e8078a2004-09-26 13:10:40 +0000103 /*
104 * Check whether it is a special value.
105 */
Lev Walkinc51e7d62004-09-27 22:16:18 +0000106 /* fpclassify(3) is not portable yet */
107 if(isnan(d)) {
Lev Walkin5f560912004-10-21 13:37:57 +0000108 buf = specialRealValue[SRV__NOT_A_NUMBER].string;
109 buflen = specialRealValue[SRV__NOT_A_NUMBER].length;
Lev Walkinc51e7d62004-09-27 22:16:18 +0000110 return (cb(buf, buflen, app_key) < 0) ? -1 : buflen;
Lev Walkindaeb2162014-01-13 23:08:35 -0800111 } else if(!_asn_isfinite(d)) {
Lev Walkinc51e7d62004-09-27 22:16:18 +0000112 if(copysign(1.0, d) < 0.0) {
Lev Walkin5f560912004-10-21 13:37:57 +0000113 buf = specialRealValue[SRV__MINUS_INFINITY].string;
114 buflen = specialRealValue[SRV__MINUS_INFINITY].length;
Lev Walkinc51e7d62004-09-27 22:16:18 +0000115 } else {
Lev Walkin5f560912004-10-21 13:37:57 +0000116 buf = specialRealValue[SRV__PLUS_INFINITY].string;
117 buflen = specialRealValue[SRV__PLUS_INFINITY].length;
Lev Walkinc51e7d62004-09-27 22:16:18 +0000118 }
119 return (cb(buf, buflen, app_key) < 0) ? -1 : buflen;
120 } else if(ilogb(d) <= -INT_MAX) {
121 if(copysign(1.0, d) < 0.0) {
122 buf = "-0";
123 buflen = 2;
124 } else {
125 buf = "0";
126 buflen = 1;
Lev Walkin8e8078a2004-09-26 13:10:40 +0000127 }
128 return (cb(buf, buflen, app_key) < 0) ? -1 : buflen;
129 }
130
131 /*
132 * Use the libc's double printing, hopefully they got it right.
133 */
Lev Walkina9cc46e2004-09-22 16:06:28 +0000134 do {
135 ret = snprintf(buf, buflen, fmt, d);
136 if(ret < 0) {
137 buflen <<= 1;
138 } else if(ret >= buflen) {
139 buflen = ret + 1;
140 } else {
141 buflen = ret;
142 break;
143 }
Lev Walkin419f6752006-09-13 04:02:00 +0000144 if(buf != local_buf) FREEMEM(buf);
Lev Walkin8e8078a2004-09-26 13:10:40 +0000145 buf = (char *)MALLOC(buflen);
Lev Walkina9cc46e2004-09-22 16:06:28 +0000146 if(!buf) return -1;
147 } while(1);
148
Lev Walkina9cc46e2004-09-22 16:06:28 +0000149 if(canonical) {
Lev Walkin92b35d22004-09-27 20:52:18 +0000150 /*
151 * Transform the "[-]d.dddE+-dd" output into "[-]d.dddE[-]d"
Lev Walkin5f560912004-10-21 13:37:57 +0000152 * Check that snprintf() constructed the output correctly.
Lev Walkin92b35d22004-09-27 20:52:18 +0000153 */
Lev Walkin8ca13c82016-01-24 22:40:00 -0800154 char *dot;
Lev Walkina9cc46e2004-09-22 16:06:28 +0000155 char *end = buf + buflen;
Lev Walkin92b35d22004-09-27 20:52:18 +0000156 char *last_zero;
Lev Walkin8ca13c82016-01-24 22:40:00 -0800157 char *prev_zero;
158 char *s;
159
160 enum {
161 LZSTATE_NOTHING,
162 LZSTATE_SEEN_ZERO
163 } lz_state = LZSTATE_NOTHING;
Lev Walkina9cc46e2004-09-22 16:06:28 +0000164
Lev Walkin5f560912004-10-21 13:37:57 +0000165 dot = (buf[0] == 0x2d /* '-' */) ? (buf + 2) : (buf + 1);
Lev Walkina9cc46e2004-09-22 16:06:28 +0000166 if(*dot >= 0x30) {
Lev Walkin78d917d2012-01-07 15:29:08 -0800167 if(buf != local_buf) FREEMEM(buf);
Lev Walkina9cc46e2004-09-22 16:06:28 +0000168 errno = EINVAL;
169 return -1; /* Not a dot, really */
170 }
Lev Walkin92b35d22004-09-27 20:52:18 +0000171 *dot = 0x2e; /* Replace possible comma */
Lev Walkina9cc46e2004-09-22 16:06:28 +0000172
Lev Walkin8ca13c82016-01-24 22:40:00 -0800173 for(prev_zero = last_zero = s = dot + 2; s < end; s++) {
174 switch(*s) {
175 case 0x45: /* 'E' */
176 if(lz_state == LZSTATE_SEEN_ZERO)
177 last_zero = prev_zero;
178 break;
179 case 0x30: /* '0' */
180 if(lz_state == LZSTATE_NOTHING)
181 prev_zero = s;
182 lz_state = LZSTATE_SEEN_ZERO;
183 continue;
184 default:
185 lz_state = LZSTATE_NOTHING;
186 continue;
187 }
188 break;
189 }
190
191 if(s == end) {
Lev Walkin78d917d2012-01-07 15:29:08 -0800192 if(buf != local_buf) FREEMEM(buf);
Lev Walkina9cc46e2004-09-22 16:06:28 +0000193 errno = EINVAL;
194 return -1; /* No promised E */
195 }
Lev Walkin8ca13c82016-01-24 22:40:00 -0800196
197 assert(*s == 0x45);
198 {
199 char *E = s;
200 char *expptr = ++E;
201 char *s = expptr;
202 int sign;
203
204 if(*expptr == 0x2b /* '+' */) {
205 /* Skip the "+" */
206 buflen -= 1;
207 sign = 0;
208 } else {
209 sign = 1;
210 s++;
211 }
212 expptr++;
213 if(expptr > end) {
214 if(buf != local_buf) FREEMEM(buf);
215 errno = EINVAL;
216 return -1;
217 }
218 if(*expptr == 0x30) {
219 buflen--;
220 expptr++;
221 }
222 if(*last_zero == 0x30) {
223 *last_zero = 0x45; /* E */
224 buflen -= s - (last_zero + 1);
225 s = last_zero + 1;
226 if(sign) {
227 *s++ = 0x2d /* '-' */;
228 buflen++;
229 }
230 }
231 for(; expptr <= end; s++, expptr++)
232 *s = *expptr;
233 }
Lev Walkin92b35d22004-09-27 20:52:18 +0000234 } else {
235 /*
236 * Remove trailing zeros.
237 */
238 char *end = buf + buflen;
239 char *last_zero = end;
Lev Walkinf0b808d2005-04-25 21:08:25 +0000240 int stoplooking = 0;
Lev Walkin92b35d22004-09-27 20:52:18 +0000241 char *z;
242 for(z = end - 1; z > buf; z--) {
243 switch(*z) {
Lev Walkinf0b808d2005-04-25 21:08:25 +0000244 case 0x30:
245 if(!stoplooking)
246 last_zero = z;
247 continue;
Lev Walkin92b35d22004-09-27 20:52:18 +0000248 case 0x31: case 0x32: case 0x33: case 0x34:
249 case 0x35: case 0x36: case 0x37: case 0x38: case 0x39:
Lev Walkinf0b808d2005-04-25 21:08:25 +0000250 stoplooking = 1;
Lev Walkin92b35d22004-09-27 20:52:18 +0000251 continue;
252 default: /* Catch dot and other separators */
Lev Walkinf0b808d2005-04-25 21:08:25 +0000253 /*
254 * Replace possible comma (which may even
255 * be not a comma at all: locale-defined).
256 */
257 *z = 0x2e;
Lev Walkin92b35d22004-09-27 20:52:18 +0000258 if(last_zero == z + 1) { /* leave x.0 */
259 last_zero++;
260 }
261 buflen = last_zero - buf;
262 *last_zero = '\0';
263 break;
264 }
265 break;
266 }
Lev Walkina9cc46e2004-09-22 16:06:28 +0000267 }
268
269 ret = cb(buf, buflen, app_key);
Lev Walkin419f6752006-09-13 04:02:00 +0000270 if(buf != local_buf) FREEMEM(buf);
Lev Walkina9cc46e2004-09-22 16:06:28 +0000271 return (ret < 0) ? -1 : buflen;
272}
273
Lev Walkin41ba1f22004-09-14 12:46:35 +0000274int
Lev Walkin5e033762004-09-29 13:26:15 +0000275REAL_print(asn_TYPE_descriptor_t *td, const void *sptr, int ilevel,
Lev Walkin41ba1f22004-09-14 12:46:35 +0000276 asn_app_consume_bytes_f *cb, void *app_key) {
277 const REAL_t *st = (const REAL_t *)sptr;
Lev Walkin8e8078a2004-09-26 13:10:40 +0000278 ssize_t ret;
Lev Walkin41ba1f22004-09-14 12:46:35 +0000279 double d;
Lev Walkin41ba1f22004-09-14 12:46:35 +0000280
281 (void)td; /* Unused argument */
282 (void)ilevel; /* Unused argument */
283
Lev Walkina9cc46e2004-09-22 16:06:28 +0000284 if(!st || !st->buf)
Lev Walkin8e8078a2004-09-26 13:10:40 +0000285 ret = cb("<absent>", 8, app_key);
Lev Walkin5e033762004-09-29 13:26:15 +0000286 else if(asn_REAL2double(st, &d))
Lev Walkin8e8078a2004-09-26 13:10:40 +0000287 ret = cb("<error>", 7, app_key);
288 else
289 ret = REAL__dump(d, 0, cb, app_key);
Lev Walkin41ba1f22004-09-14 12:46:35 +0000290
Lev Walkin8e8078a2004-09-26 13:10:40 +0000291 return (ret < 0) ? -1 : 0;
Lev Walkina9cc46e2004-09-22 16:06:28 +0000292}
Lev Walkin41ba1f22004-09-14 12:46:35 +0000293
Lev Walkina9cc46e2004-09-22 16:06:28 +0000294asn_enc_rval_t
Lev Walkin5e033762004-09-29 13:26:15 +0000295REAL_encode_xer(asn_TYPE_descriptor_t *td, void *sptr,
Lev Walkina9cc46e2004-09-22 16:06:28 +0000296 int ilevel, enum xer_encoder_flags_e flags,
297 asn_app_consume_bytes_f *cb, void *app_key) {
298 REAL_t *st = (REAL_t *)sptr;
299 asn_enc_rval_t er;
300 double d;
301
302 (void)ilevel;
303
Lev Walkin5e033762004-09-29 13:26:15 +0000304 if(!st || !st->buf || asn_REAL2double(st, &d))
Lev Walkin7c1dc052016-03-14 03:08:15 -0700305 ASN__ENCODE_FAILED;
Lev Walkina9cc46e2004-09-22 16:06:28 +0000306
307 er.encoded = REAL__dump(d, flags & XER_F_CANONICAL, cb, app_key);
Lev Walkin7c1dc052016-03-14 03:08:15 -0700308 if(er.encoded < 0) ASN__ENCODE_FAILED;
Lev Walkina9cc46e2004-09-22 16:06:28 +0000309
Lev Walkin7c1dc052016-03-14 03:08:15 -0700310 ASN__ENCODED_OK(er);
Lev Walkin41ba1f22004-09-14 12:46:35 +0000311}
312
Lev Walkin5f560912004-10-21 13:37:57 +0000313
314/*
315 * Decode the chunk of XML text encoding REAL.
316 */
Lev Walkin0fab1a62005-03-09 22:19:25 +0000317static enum xer_pbd_rval
318REAL__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 +0000319 REAL_t *st = (REAL_t *)sptr;
Lev Walkin5f560912004-10-21 13:37:57 +0000320 double value;
Lev Walkin0fab1a62005-03-09 22:19:25 +0000321 const char *xerdata = (const char *)chunk_buf;
Lev Walkin5f560912004-10-21 13:37:57 +0000322 char *endptr = 0;
323 char *b;
324
Lev Walkine0b56e02005-02-25 12:10:27 +0000325 (void)td;
326
Lev Walkin0fab1a62005-03-09 22:19:25 +0000327 if(!chunk_size) return XPBD_BROKEN_ENCODING;
Lev Walkin5f560912004-10-21 13:37:57 +0000328
329 /*
330 * Decode an XMLSpecialRealValue: <MINUS-INFINITY>, etc.
331 */
332 if(xerdata[0] == 0x3c /* '<' */) {
333 size_t i;
334 for(i = 0; i < sizeof(specialRealValue)
335 / sizeof(specialRealValue[0]); i++) {
336 struct specialRealValue_s *srv = &specialRealValue[i];
Lev Walkin1aea6982004-10-26 09:35:25 +0000337 double dv;
338
Lev Walkin5f560912004-10-21 13:37:57 +0000339 if(srv->length != chunk_size
340 || memcmp(srv->string, chunk_buf, chunk_size))
341 continue;
342
Lev Walkin1aea6982004-10-26 09:35:25 +0000343 /*
344 * It could've been done using
345 * (double)srv->dv / real_zero,
346 * but it summons fp exception on some platforms.
347 */
348 switch(srv->dv) {
349 case -1: dv = - INFINITY; break;
350 case 0: dv = NAN; break;
351 case 1: dv = INFINITY; break;
Lev Walkin0fab1a62005-03-09 22:19:25 +0000352 default: return XPBD_SYSTEM_FAILURE;
Lev Walkin1aea6982004-10-26 09:35:25 +0000353 }
354
Lev Walkin0fab1a62005-03-09 22:19:25 +0000355 if(asn_double2REAL(st, dv))
356 return XPBD_SYSTEM_FAILURE;
Lev Walkin5f560912004-10-21 13:37:57 +0000357
Lev Walkin0fab1a62005-03-09 22:19:25 +0000358 return XPBD_BODY_CONSUMED;
Lev Walkin5f560912004-10-21 13:37:57 +0000359 }
360 ASN_DEBUG("Unknown XMLSpecialRealValue");
Lev Walkin0fab1a62005-03-09 22:19:25 +0000361 return XPBD_BROKEN_ENCODING;
Lev Walkin5f560912004-10-21 13:37:57 +0000362 }
363
364 /*
365 * Copy chunk into the nul-terminated string, and run strtod.
366 */
Lev Walkin8471cec2004-10-21 14:02:19 +0000367 b = (char *)MALLOC(chunk_size + 1);
Lev Walkin0fab1a62005-03-09 22:19:25 +0000368 if(!b) return XPBD_SYSTEM_FAILURE;
Lev Walkin5f560912004-10-21 13:37:57 +0000369 memcpy(b, chunk_buf, chunk_size);
Lev Walkin8471cec2004-10-21 14:02:19 +0000370 b[chunk_size] = 0; /* nul-terminate */
Lev Walkin5f560912004-10-21 13:37:57 +0000371
372 value = strtod(b, &endptr);
Lev Walkin419f6752006-09-13 04:02:00 +0000373 FREEMEM(b);
Lev Walkin0fab1a62005-03-09 22:19:25 +0000374 if(endptr == b) return XPBD_BROKEN_ENCODING;
Lev Walkin5f560912004-10-21 13:37:57 +0000375
376 if(asn_double2REAL(st, value))
Lev Walkin0fab1a62005-03-09 22:19:25 +0000377 return XPBD_SYSTEM_FAILURE;
Lev Walkin5f560912004-10-21 13:37:57 +0000378
Lev Walkin0fab1a62005-03-09 22:19:25 +0000379 return XPBD_BODY_CONSUMED;
Lev Walkin5f560912004-10-21 13:37:57 +0000380}
381
382asn_dec_rval_t
383REAL_decode_xer(asn_codec_ctx_t *opt_codec_ctx,
384 asn_TYPE_descriptor_t *td, void **sptr, const char *opt_mname,
Lev Walkin8c3b8542005-03-10 18:52:02 +0000385 const void *buf_ptr, size_t size) {
Lev Walkin5f560912004-10-21 13:37:57 +0000386
387 return xer_decode_primitive(opt_codec_ctx, td,
Lev Walkin8471cec2004-10-21 14:02:19 +0000388 sptr, sizeof(REAL_t), opt_mname,
Lev Walkin5f560912004-10-21 13:37:57 +0000389 buf_ptr, size, REAL__xer_body_decode);
390}
391
Lev Walkin725883b2006-10-09 12:07:58 +0000392asn_dec_rval_t
393REAL_decode_uper(asn_codec_ctx_t *opt_codec_ctx,
394 asn_TYPE_descriptor_t *td, asn_per_constraints_t *constraints,
395 void **sptr, asn_per_data_t *pd) {
396 (void)constraints; /* No PER visible constraints */
397 return OCTET_STRING_decode_uper(opt_codec_ctx, td, 0, sptr, pd);
398}
399
400asn_enc_rval_t
401REAL_encode_uper(asn_TYPE_descriptor_t *td,
402 asn_per_constraints_t *constraints, void *sptr, asn_per_outp_t *po) {
403 (void)constraints; /* No PER visible constraints */
404 return OCTET_STRING_encode_uper(td, 0, sptr, po);
405}
Lev Walkin5f560912004-10-21 13:37:57 +0000406
Lev Walkin41ba1f22004-09-14 12:46:35 +0000407int
Lev Walkin5e033762004-09-29 13:26:15 +0000408asn_REAL2double(const REAL_t *st, double *dbl_value) {
Lev Walkina9cc46e2004-09-22 16:06:28 +0000409 unsigned int octv;
Lev Walkin41ba1f22004-09-14 12:46:35 +0000410
411 if(!st || !st->buf) {
412 errno = EINVAL;
413 return -1;
414 }
415
416 if(st->size == 0) {
417 *dbl_value = 0;
418 return 0;
419 }
420
421 octv = st->buf[0]; /* unsigned byte */
422
423 switch(octv & 0xC0) {
Lev Walkin5fda7d52012-01-09 03:20:19 -0800424 case 0x40: /* X.690: 8.5.6 a) => 8.5.9 */
Lev Walkin41ba1f22004-09-14 12:46:35 +0000425 /* "SpecialRealValue" */
426
427 /* Be liberal in what you accept...
Lev Walkin749916f2012-01-07 17:03:39 -0800428 * http://en.wikipedia.org/wiki/Robustness_principle
Lev Walkin41ba1f22004-09-14 12:46:35 +0000429 if(st->size != 1) ...
430 */
431
432 switch(st->buf[0]) {
433 case 0x40: /* 01000000: PLUS-INFINITY */
Lev Walkin1aea6982004-10-26 09:35:25 +0000434 *dbl_value = INFINITY;
Lev Walkin41ba1f22004-09-14 12:46:35 +0000435 return 0;
436 case 0x41: /* 01000001: MINUS-INFINITY */
Lev Walkin1aea6982004-10-26 09:35:25 +0000437 *dbl_value = - INFINITY;
Lev Walkin41ba1f22004-09-14 12:46:35 +0000438 return 0;
Lev Walkin41ba1f22004-09-14 12:46:35 +0000439 case 0x42: /* 01000010: NOT-A-NUMBER */
440 *dbl_value = NAN;
441 return 0;
442 case 0x43: /* 01000011: minus zero */
Lev Walkin2a789d92004-09-27 21:36:59 +0000443 *dbl_value = -0.0;
Lev Walkin41ba1f22004-09-14 12:46:35 +0000444 return 0;
445 }
446
447 errno = EINVAL;
448 return -1;
Lev Walkin0959ffb2011-06-25 15:48:52 -0700449 case 0x00: { /* X.690: 8.5.7 */
Lev Walkin41ba1f22004-09-14 12:46:35 +0000450 /*
Lev Walkin5fda7d52012-01-09 03:20:19 -0800451 * Decimal. NR{1,2,3} format from ISO 6093.
452 * NR1: [ ]*[+-]?[0-9]+
453 * NR2: [ ]*[+-]?([0-9]+\.[0-9]*|[0-9]*\.[0-9]+)
454 * NR3: [ ]*[+-]?([0-9]+\.[0-9]*|[0-9]*\.[0-9]+)[Ee][+-]?[0-9]+
Lev Walkin41ba1f22004-09-14 12:46:35 +0000455 */
456 double d;
Lev Walkin5fda7d52012-01-09 03:20:19 -0800457 char *buf;
458 char *endptr;
459 int used_malloc = 0;
Lev Walkin41ba1f22004-09-14 12:46:35 +0000460
Lev Walkin5fda7d52012-01-09 03:20:19 -0800461 if(octv == 0 || (octv & 0x3C)) {
Lev Walkin0959ffb2011-06-25 15:48:52 -0700462 /* Remaining values of bits 6 to 1 are Reserved. */
463 errno = EINVAL;
464 return -1;
465 }
Lev Walkin41ba1f22004-09-14 12:46:35 +0000466
Lev Walkin5fda7d52012-01-09 03:20:19 -0800467
468 /* 1. By contract, an input buffer should be null-terminated.
469 * OCTET STRING decoder ensures that, as is asn_double2REAL().
470 * 2. ISO 6093 specifies COMMA as a possible decimal separator.
471 * However, strtod() can't always deal with COMMA.
472 * So her we fix both by reallocating, copying and fixing.
473 */
474 if(st->buf[st->size] || memchr(st->buf, ',', st->size)) {
475 uint8_t *p, *end;
476 char *b;
477 if(st->size > 100) {
478 /* Avoid malicious stack overflow in alloca() */
479 buf = (char *)MALLOC(st->size);
480 if(!buf) return -1;
481 used_malloc = 1;
482 } else {
483 buf = alloca(st->size);
484 }
485 b = buf;
486 /* Copy without the first byte and with 0-termination */
487 for(p = st->buf + 1, end = st->buf + st->size;
488 p < end; b++, p++)
489 *b = (*p == ',') ? '.' : *p;
490 *b = '\0';
491 } else {
492 buf = (char *)&st->buf[1];
493 }
494
495 endptr = buf;
496 d = strtod(buf, &endptr);
497 if(*endptr != '\0') {
498 /* Format is not consistent with ISO 6093 */
499 if(used_malloc) FREEMEM(buf);
Lev Walkin0959ffb2011-06-25 15:48:52 -0700500 errno = EINVAL;
501 return -1;
502 }
Lev Walkin5fda7d52012-01-09 03:20:19 -0800503 if(used_malloc) FREEMEM(buf);
Lev Walkindaeb2162014-01-13 23:08:35 -0800504 if(_asn_isfinite(d)) {
Lev Walkin41ba1f22004-09-14 12:46:35 +0000505 *dbl_value = d;
506 return 0;
507 } else {
508 errno = ERANGE;
Lev Walkin0959ffb2011-06-25 15:48:52 -0700509 return -1;
Lev Walkin41ba1f22004-09-14 12:46:35 +0000510 }
511 }
512 }
513
514 /*
515 * Binary representation.
516 */
517 {
518 double m;
519 int expval; /* exponent value */
520 unsigned int elen; /* exponent value length, in octets */
521 unsigned int scaleF;
522 unsigned int baseF;
523 uint8_t *ptr;
524 uint8_t *end;
525 int sign;
526
527 switch((octv & 0x30) >> 4) {
528 case 0x00: baseF = 1; break; /* base 2 */
529 case 0x01: baseF = 3; break; /* base 8 */
530 case 0x02: baseF = 4; break; /* base 16 */
531 default:
532 /* Reserved field, can't parse now. */
533 errno = EINVAL;
534 return -1;
535 }
536
537 sign = (octv & 0x40); /* bit 7 */
538 scaleF = (octv & 0x0C) >> 2; /* bits 4 to 3 */
539
Lev Walkina9cc46e2004-09-22 16:06:28 +0000540 if(st->size <= (int)(1 + (octv & 0x03))) {
Lev Walkin41ba1f22004-09-14 12:46:35 +0000541 errno = EINVAL;
542 return -1;
543 }
544
Lev Walkine78753d2007-06-23 17:02:00 +0000545 elen = (octv & 0x03); /* bits 2 to 1; 8.5.6.4 */
546 if(elen == 0x03) { /* bits 2 to 1 = 11; 8.5.6.4, case d) */
Lev Walkin41ba1f22004-09-14 12:46:35 +0000547 elen = st->buf[1]; /* unsigned binary number */
Lev Walkina9cc46e2004-09-22 16:06:28 +0000548 if(elen == 0 || st->size <= (int)(2 + elen)) {
Lev Walkin41ba1f22004-09-14 12:46:35 +0000549 errno = EINVAL;
550 return -1;
551 }
Lev Walkine78753d2007-06-23 17:02:00 +0000552 /* FIXME: verify constraints of case d) */
Lev Walkin41ba1f22004-09-14 12:46:35 +0000553 ptr = &st->buf[2];
554 } else {
Lev Walkin41ba1f22004-09-14 12:46:35 +0000555 ptr = &st->buf[1];
556 }
557
558 /* Fetch the multibyte exponent */
559 expval = (int)(*(int8_t *)ptr);
560 end = ptr + elen + 1;
561 for(ptr++; ptr < end; ptr++)
562 expval = (expval * 256) + *ptr;
563
564 m = 0.0; /* Initial mantissa value */
565
566 /* Okay, the exponent is here. Now, what about mantissa? */
567 end = st->buf + st->size;
Lev Walkin5fda7d52012-01-09 03:20:19 -0800568 for(; ptr < end; ptr++)
569 m = ldexp(m, 8) + *ptr;
Lev Walkin41ba1f22004-09-14 12:46:35 +0000570
Lev Walkin5f560912004-10-21 13:37:57 +0000571 if(0)
Lev Walkin5fda7d52012-01-09 03:20:19 -0800572 ASN_DEBUG("m=%.10f, scF=%d, bF=%d, expval=%d, ldexp()=%f, ldexp()=%f\n",
Lev Walkin41ba1f22004-09-14 12:46:35 +0000573 m, scaleF, baseF, expval,
574 ldexp(m, expval * baseF + scaleF),
Lev Walkin77aa90f2005-04-28 22:56:36 +0000575 ldexp(m, scaleF) * pow(pow(2, baseF), expval)
Lev Walkin41ba1f22004-09-14 12:46:35 +0000576 );
577
578 /*
579 * (S * N * 2^F) * B^E
580 * Essentially:
Lev Walkin77aa90f2005-04-28 22:56:36 +0000581 m = ldexp(m, scaleF) * pow(pow(2, base), expval);
Lev Walkin41ba1f22004-09-14 12:46:35 +0000582 */
583 m = ldexp(m, expval * baseF + scaleF);
Lev Walkindaeb2162014-01-13 23:08:35 -0800584 if(_asn_isfinite(m)) {
Lev Walkin41ba1f22004-09-14 12:46:35 +0000585 *dbl_value = sign ? -m : m;
586 } else {
587 errno = ERANGE;
588 return -1;
589 }
590
591 } /* if(binary_format) */
592
593 return 0;
594}
595
596/*
597 * Assume IEEE 754 floating point: standard 64 bit double.
598 * [1 bit sign] [11 bits exponent] [52 bits mantissa]
599 */
600int
Lev Walkin5e033762004-09-29 13:26:15 +0000601asn_double2REAL(REAL_t *st, double dbl_value) {
Lev Walkin41ba1f22004-09-14 12:46:35 +0000602#ifdef WORDS_BIGENDIAN /* Known to be big-endian */
603 int littleEndian = 0;
604#else /* need to test: have no explicit information */
605 unsigned int LE = 1;
606 int littleEndian = *(unsigned char *)&LE;
607#endif
608 uint8_t buf[16]; /* More than enough for 8-byte dbl_value */
609 uint8_t dscr[sizeof(dbl_value)]; /* double value scratch pad */
610 /* Assertion guards: won't even compile, if unexpected double size */
Lev Walkin50b0f6c2006-10-16 12:01:36 +0000611 char assertion_buffer1[9 - sizeof(dbl_value)] GCC_NOTUSED;
612 char assertion_buffer2[sizeof(dbl_value) - 7] GCC_NOTUSED;
Lev Walkin41ba1f22004-09-14 12:46:35 +0000613 uint8_t *ptr = buf;
614 uint8_t *mstop; /* Last byte of mantissa */
615 unsigned int mval; /* Value of the last byte of mantissa */
616 unsigned int bmsign; /* binary mask with sign */
617 unsigned int buflen;
618 unsigned int accum;
619 int expval;
620
621 if(!st) {
622 errno = EINVAL;
623 return -1;
624 }
625
Lev Walkin057fb732004-09-14 13:58:10 +0000626 /*
627 * ilogb(+-0) returns -INT_MAX or INT_MIN (platform-dependent)
Lev Walkin2f505022005-07-01 08:28:18 +0000628 * ilogb(+-inf) returns INT_MAX, logb(+-inf) returns +inf
Lev Walkin2a789d92004-09-27 21:36:59 +0000629 * ilogb(NaN) returns INT_MIN or INT_MAX (platform-dependent)
Lev Walkin057fb732004-09-14 13:58:10 +0000630 */
Lev Walkin41ba1f22004-09-14 12:46:35 +0000631 expval = ilogb(dbl_value);
Lev Walkin2a789d92004-09-27 21:36:59 +0000632 if(expval <= -INT_MAX /* Also catches +-0 and maybe isnan() */
633 || expval == INT_MAX /* catches isfin() and maybe isnan() */
Lev Walkin41ba1f22004-09-14 12:46:35 +0000634 ) {
635 if(!st->buf || st->size < 2) {
Lev Walkin8e8078a2004-09-26 13:10:40 +0000636 ptr = (uint8_t *)MALLOC(2);
Lev Walkin41ba1f22004-09-14 12:46:35 +0000637 if(!ptr) return -1;
638 st->buf = ptr;
639 }
640 /* fpclassify(3) is not portable yet */
Lev Walkin2a789d92004-09-27 21:36:59 +0000641 if(isnan(dbl_value)) {
642 st->buf[0] = 0x42; /* NaN */
643 st->buf[1] = 0;
644 st->size = 1;
Lev Walkindaeb2162014-01-13 23:08:35 -0800645 } else if(!_asn_isfinite(dbl_value)) {
Lev Walkin7e03db92004-09-14 13:50:21 +0000646 if(copysign(1.0, dbl_value) < 0.0) {
Lev Walkin41ba1f22004-09-14 12:46:35 +0000647 st->buf[0] = 0x41; /* MINUS-INFINITY */
648 } else {
649 st->buf[0] = 0x40; /* PLUS-INFINITY */
650 }
651 st->buf[1] = 0;
652 st->size = 1;
Lev Walkinc51e7d62004-09-27 22:16:18 +0000653 } else {
Lev Walkin5fe72e92012-01-07 17:00:29 -0800654 if(copysign(1.0, dbl_value) >= 0.0) {
Lev Walkinc51e7d62004-09-27 22:16:18 +0000655 /* no content octets: positive zero */
656 st->buf[0] = 0; /* JIC */
657 st->size = 0;
Lev Walkin5fe72e92012-01-07 17:00:29 -0800658 } else {
659 /* Negative zero. #8.5.3, 8.5.9 */
660 st->buf[0] = 0x43;
661 st->size = 1;
Lev Walkinc51e7d62004-09-27 22:16:18 +0000662 }
Lev Walkin41ba1f22004-09-14 12:46:35 +0000663 }
664 return 0;
665 }
666
667 if(littleEndian) {
668 uint8_t *s = ((uint8_t *)&dbl_value) + sizeof(dbl_value) - 2;
Lev Walkin057fb732004-09-14 13:58:10 +0000669 uint8_t *start = ((uint8_t *)&dbl_value);
Lev Walkin41ba1f22004-09-14 12:46:35 +0000670 uint8_t *d;
671
672 bmsign = 0x80 | ((s[1] >> 1) & 0x40); /* binary mask & - */
Lev Walkin057fb732004-09-14 13:58:10 +0000673 for(mstop = d = dscr; s >= start; d++, s--) {
Lev Walkin41ba1f22004-09-14 12:46:35 +0000674 *d = *s;
675 if(*d) mstop = d;
676 }
677 } else {
678 uint8_t *s = ((uint8_t *)&dbl_value) + 1;
679 uint8_t *end = ((uint8_t *)&dbl_value) + sizeof(double);
680 uint8_t *d;
681
682 bmsign = 0x80 | ((s[-1] >> 1) & 0x40); /* binary mask & - */
683 for(mstop = d = dscr; s < end; d++, s++) {
684 *d = *s;
685 if(*d) mstop = d;
686 }
687 }
688
689 /* Remove parts of the exponent, leave mantissa and explicit 1. */
690 dscr[0] = 0x10 | (dscr[0] & 0x0f);
691
692 /* Adjust exponent in a very unobvious way */
693 expval -= 8 * ((mstop - dscr) + 1) - 4;
694
695 /* This loop ensures DER conformance by forcing mantissa odd: 11.3.1 */
696 mval = *mstop;
697 if(mval && !(mval & 1)) {
698 unsigned int shift_count = 1;
699 unsigned int ishift;
700 uint8_t *mptr;
701
702 /*
703 * Figure out what needs to be done to make mantissa odd.
704 */
705 if(!(mval & 0x0f)) /* Speed-up a little */
706 shift_count = 4;
707 while(((mval >> shift_count) & 1) == 0)
708 shift_count++;
709
710 ishift = 8 - shift_count;
711 accum = 0;
712
713 /* Go over the buffer, shifting it shift_count bits right. */
714 for(mptr = dscr; mptr <= mstop; mptr++) {
715 mval = *mptr;
716 *mptr = accum | (mval >> shift_count);
717 accum = mval << ishift;
718 }
719
Lev Walkinb89b3402012-01-09 18:26:30 -0800720 /* Adjust exponent appropriately. */
Lev Walkin41ba1f22004-09-14 12:46:35 +0000721 expval += shift_count;
722 }
723
724 if(expval < 0) {
725 if((expval >> 7) == -1) {
726 *ptr++ = bmsign | 0x00;
727 *ptr++ = expval;
728 } else if((expval >> 15) == -1) {
729 *ptr++ = bmsign | 0x01;
730 *ptr++ = expval >> 8;
731 *ptr++ = expval;
732 } else {
Lev Walkin41ba1f22004-09-14 12:46:35 +0000733 *ptr++ = bmsign | 0x02;
734 *ptr++ = expval >> 16;
735 *ptr++ = expval >> 8;
736 *ptr++ = expval;
737 }
738 } else if(expval <= 0x7f) {
739 *ptr++ = bmsign | 0x00;
740 *ptr++ = expval;
741 } else if(expval <= 0x7fff) {
742 *ptr++ = bmsign | 0x01;
743 *ptr++ = expval >> 8;
744 *ptr++ = expval;
745 } else {
746 assert(expval <= 0x7fffff);
747 *ptr++ = bmsign | 0x02;
748 *ptr++ = expval >> 16;
749 *ptr++ = expval >> 8;
750 *ptr++ = expval;
751 }
752
753 buflen = (mstop - dscr) + 1;
754 memcpy(ptr, dscr, buflen);
755 ptr += buflen;
756 buflen = ptr - buf;
757
Lev Walkinc17d90f2005-01-17 14:32:45 +0000758 ptr = (uint8_t *)MALLOC(buflen + 1);
Lev Walkin41ba1f22004-09-14 12:46:35 +0000759 if(!ptr) return -1;
760
761 memcpy(ptr, buf, buflen);
762 buf[buflen] = 0; /* JIC */
763
764 if(st->buf) FREEMEM(st->buf);
765 st->buf = ptr;
766 st->size = buflen;
767
768 return 0;
769}