adding ode source to /libraries

1 files changed, 30 insertions, 0 deletions

diff --git a/libraries/ode-0.9\/ode/src/fastdot.c b/libraries/ode-0.9\/ode/src/fastdot.c
new file mode 100755
index 0000000..148d2dd
--- /dev/null
+++ b/libraries/ode-0.9\/ode/src/fastdot.c
@@ -0,0 +1,30 @@
+/* generated code, do not edit. */
+
+#include "ode/matrix.h"
+
+
+dReal dDot (const dReal *a, const dReal *b, int n)
+{  
+  dReal p0,q0,m0,p1,q1,m1,sum;
+  sum = 0;
+  n -= 2;
+  while (n >= 0) {
+    p0 = a[0]; q0 = b[0];
+    m0 = p0 * q0;
+    p1 = a[1]; q1 = b[1];
+    m1 = p1 * q1;
+    sum += m0;
+    sum += m1;
+    a += 2;
+    b += 2;
+    n -= 2;
+  }
+  n += 2;
+  while (n > 0) {
+    sum += (*a) * (*b);
+    a++;
+    b++;
+    n--;
+  }
+  return sum;
+}