ode/src/fastdot.c
author Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com>
Tue, 06 Jul 2010 14:33:00 +0300
changeset 40 7165f928e888
parent 0 2f259fa3e83a
permissions -rw-r--r--
Revision: 201025 Kit: 2010127

/* 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;
}