index 421e25d..6130f54 100644 (file)
@@ -1,6 +1,6 @@
/*
* The olsr.org Optimized Link-State Routing daemon(olsrd)
- * Copyright (c) 2004, Andreas Tønnesen(andreto@olsr.org)
+ * Copyright (c) 2004, Andreas Tønnesen(andreto@olsr.org)
* All rights reserved.
*
* Redistribution and use in source and binary forms, with or without
* to the project. For more information see the website or contact
*
- * \$Id: mantissa.c,v 1.6 2004/11/21 11:28:56 kattemat Exp \$
+ * \$Id: mantissa.c,v 1.10 2007/11/29 18:09:11 bernd67 Exp \$
*/

-
#include "mantissa.h"
-#include "math.h"

/**
*Function that converts a double to a mantissa/exponent
*/

olsr_u8_t
-double_to_me(double interval)
+double_to_me(const double interval)
{
-  int a, b;
-
-  b = 0;
+    olsr_u8_t a, b;

-  while(interval / VTIME_SCALE_FACTOR >= pow((double)2, (double)b))
-    b++;
+    /* It is sufficent to compare the integer part since we test on >=.
+     * So we have now only a floating point division and the rest of the loop
+     * are only integer operations.
+     */
+    const unsigned int unscaled_interval = interval / VTIME_SCALE_FACTOR;
+    b = 0;
+    while (unscaled_interval >= (1U << b)) {
+        b++;
+    }

-  b--;
-  if(b < 0)
-    {
-      a = 1;
-      b = 0;
-    }
-  else
-    if (b > 15)
-      {
-       a = 15;
-       b = 15;
-      }
-    else
-      {
-       a = (int)(16*((double)interval/(VTIME_SCALE_FACTOR*(double)pow(2,b))-1));
-       while(a >= 16)
-         {
-           a -= 16;
-           b++;
-         }
-      }
-
-  //printf("Generated mantissa/exponent(%d/%d): %d from %f\n", a, b, (olsr_u8_t) (a*16+b), interval);
-  //printf("Resolves back to: %f\n", me_to_double((olsr_u8_t) (a*16+b)));
-  return (olsr_u8_t) (a*16+b);
+    if(b == 0) {
+        a = 1;
+        b = 0;
+    } else {
+        b--;
+        if (b > 15) {
+            a = 15;
+            b = 15;
+        } else {
+            /* And again some maths simplification from the former version:
+             *    a = 16 * ((double)interval / (VTIME_SCALE_FACTOR * (double)(1 << b)) - 1)
+             * Since interval is already double:
+             *    a = 16 * (interval / (VTIME_SCALE_FACTOR * (double)(1 << b)) - 1)
+             * first, we can get rid of parentheses and change the * to a /
+             *    a = 16 * (interval / VTIME_SCALE_FACTOR / (double)(1 << b) - 1)
+             * then we make an integer addition from the floating point addition
+             *    a = (int)(16.0 * interval / VTIME_SCALE_FACTOR / (double)(1 << b)) - 16
+             * and we loose an unnecessary cast
+             *    a = (int)(16.0 * interval / VTIME_SCALE_FACTOR / (1 << b)) - 16
+             */
+            a = (int)(16.0 * interval / VTIME_SCALE_FACTOR / (1 << b)) - 16;
+            b += a >> 4;
+            a &= 0x0f;
+        }
+    }
+    //printf("Generated mantissa/exponent(%d/%d): %d from %f\n", a, b, (olsr_u8_t) (a*16+b), interval);  //printf("Resolves back to: %f\n", me_to_double(((a<<4)|(b&0x0F))));
+    return (a << 4) | (b & 0x0F);
}

-
-
-
/**
- *Function that converts a mantissa/exponent 8bit value back
- *to double as described in RFC3626:
+ * Function for converting a mantissa/exponent 8bit value back
+ * to double as described in RFC3626:
*
* value = C*(1+a/16)*2^b [in seconds]
*
@@ -108,17 +110,24 @@ double_to_me(double interval)
*  field and b the integer represented by the four lowest bits of the
*  field.
*
- *@param me the 8 bit mantissa/exponen value
+ * me is the 8 bit mantissa/exponent value
*
- *@return a double value
+ * To avoid expensive floating maths, we transform the equation:
+ *     value = C * (1 + a / 16) * 2^b
+ * first, we make an int addition from the floating point addition:
+ *     value = C * ((16 + a) / 16) * 2^b
+ * then we get rid of a pair of parentheses
+ *     value = C * (16 + a) / 16 * 2^b
+ * and now we make an int multiplication from the floating point one
+ *     value = C * (16 + a) * 2^b / 16
+ * so that we can make a shift from the multiplication
+ *     value = C * ((16 + a) << b) / 16
+ * and sionce C and 16 are constants
+ *     value = ((16 + a) << b) * C / 16
*/
-double
-me_to_double(olsr_u8_t me)
+double me_to_double(const olsr_u8_t me)
{
-  int a, b;
-
-  a = me>>4;
-  b = me - a*16;
-
-  return (double)(VTIME_SCALE_FACTOR*(1+(double)a/16)*(double)pow(2,b));
+    const olsr_u8_t a = me >> 4;
+    const olsr_u8_t b = me & 0x0F;
+    return ((16 + a) << b) * VTIME_SCALE_FACTOR / 16.0;
}