ode/src/fastdot.c
author Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com>
Fri, 14 May 2010 16:06:26 +0300
changeset 22 75713bee6484
parent 0 2f259fa3e83a
permissions -rw-r--r--
Revision: 201017 Kit: 201019

/* generated code, do not edit. */

#include <ode/matrix.h>


EXPORT_C 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 = dMUL(p0,q0);
    p1 = a[1]; q1 = b[1];
    m1 = dMUL(p1,q1);
    sum += m0;
    sum += m1;
    a += 2;
    b += 2;
    n -= 2;
  }
  n += 2;
  while (n > 0) {
    sum += dMUL((*a),(*b));
    a++;
    b++;
    n--;
  }
  return sum;
}