From 27767aafa21754e6cdbf52a719e7ce395f0fe672 Mon Sep 17 00:00:00 2001
From: =?UTF-8?q?Zolt=C3=A1n=20V=C3=B6r=C3=B6s?= <zvoros@gmail.com>
Date: Sat, 15 Feb 2020 19:28:56 +0100
Subject: [PATCH] lib/libm_dbl: Add round.c source code.

This code is imported from musl, to match existing code in libm_dbl.

The file is also added to the build in stm32/Makefile.  It's not needed by
the core code but, similar to c5cc64175be32cb1e4f3f1a249667bc9f5a12613,
allows round() to be used by user C modules or board extensions.
---
 lib/libm_dbl/round.c | 35 +++++++++++++++++++++++++++++++++++
 ports/stm32/Makefile |  1 +
 2 files changed, 36 insertions(+)
 create mode 100644 lib/libm_dbl/round.c

diff --git a/lib/libm_dbl/round.c b/lib/libm_dbl/round.c
new file mode 100644
index 0000000000..130d58d257
--- /dev/null
+++ b/lib/libm_dbl/round.c
@@ -0,0 +1,35 @@
+#include "libm.h"
+
+#if FLT_EVAL_METHOD==0 || FLT_EVAL_METHOD==1
+#define EPS DBL_EPSILON
+#elif FLT_EVAL_METHOD==2
+#define EPS LDBL_EPSILON
+#endif
+static const double_t toint = 1/EPS;
+
+double round(double x)
+{
+	union {double f; uint64_t i;} u = {x};
+	int e = u.i >> 52 & 0x7ff;
+	double_t y;
+
+	if (e >= 0x3ff+52)
+		return x;
+	if (u.i >> 63)
+		x = -x;
+	if (e < 0x3ff-1) {
+		/* raise inexact if x!=0 */
+		FORCE_EVAL(x + toint);
+		return 0*u.f;
+	}
+	y = x + toint - toint - x;
+	if (y > 0.5)
+		y = y + x - 1;
+	else if (y <= -0.5)
+		y = y + x + 1;
+	else
+		y = y + x;
+	if (u.i >> 63)
+		y = -y;
+	return y;
+}
diff --git a/ports/stm32/Makefile b/ports/stm32/Makefile
index fe8f0b8711..e7d2e2abc2 100644
--- a/ports/stm32/Makefile
+++ b/ports/stm32/Makefile
@@ -191,6 +191,7 @@ LIBM_SRC_C = $(addprefix lib/libm_dbl/,\
 	nearbyint.c \
 	pow.c \
 	rint.c \
+	round.c \
 	scalbn.c \
 	sin.c \
 	sinh.c \