X-Git-Url: http://shamusworld.gotdns.org/cgi-bin/gitweb.cgi?p=rmac;a=blobdiff_plain;f=fltpoint.c;h=911e0085ae2729b6c513cf16f975061a86287adb;hp=fa1eb41ad9c78af887a63b444f099a4ecf184d95;hb=261f8d9198c4235bcdced4403ba391553e6bd0d1;hpb=ae528e6fdb8bd5c41ed9690bec03402ccbb4ecae

diff --git a/fltpoint.c b/fltpoint.c
index fa1eb41..911e008 100644
--- a/fltpoint.c
+++ b/fltpoint.c
@@ -14,6 +14,7 @@
 #include "fltpoint.h"
 #include <float.h>
 #include <math.h>
+#include <stdio.h>
 
 //
 // Check for IEEE-754 conformance (C99 compilers should be OK here)
@@ -169,3 +170,25 @@ void DoubleToExtended(double d, uint8_t out[])
 	out[11] = intMant & 0xFF;
 }
 
+
+//
+// Convert a host native floating point number to a fixed point number.
+//
+uint64_t DoubleToFixedPoint(double d, int intBits, int fracBits)
+{
+	uint8_t signBit = (signbit(d) ? 1 : 0);
+
+	// Ensure what we're working on is positive...
+	if (d < 0)
+		d *= -1;
+
+	double scaleFactor = (double)(1 << fracBits);
+	uint64_t result = (uint64_t)(d * scaleFactor);
+
+	// Invert the result, if necessary
+	if (signBit == 1)
+		result = (result = 0xFFFFFFFFFFFFFFFFLL) + 1;
+
+	return result;
+}
+