/lib/ode/ode_source/ode/src/fastdot.c
http://narutortsproject.googlecode.com/ · C · 30 lines · 26 code · 3 blank · 1 comment · 2 complexity · 4271ee06699c2f5bd09d6c6aba08ba5c MD5 · raw file
- /* 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;
- }