MCPcopy Create free account
hub / github.com/OGSR/OGSR-Engine / dMultiply0

Function dMultiply0

3rd_party/Src/ode/ode/src/matrix.cpp:50–71  ·  view source on GitHub ↗

Source from the content-addressed store, hash-verified

48
49
50void dMultiply0 (dReal *A, const dReal *B, const dReal *C, int p, int q, int r)
51{
52 int i,j,k,qskip,rskip,rpad;
53 dAASSERT (A && B && C && p>0 && q>0 && r>0);
54 qskip = dPAD(q);
55 rskip = dPAD(r);
56 rpad = rskip - r;
57 dReal sum;
58 const dReal *b,*c,*bb;
59 bb = B;
60 for (i=p; i; i--) {
61 for (j=0 ; j<r; j++) {
62 c = C + j;
63 b = bb;
64 sum = 0;
65 for (k=q; k; k--, c+=rskip) sum += (*(b++))*(*c);
66 *(A++) = sum;
67 }
68 A += rpad;
69 bb += qskip;
70 }
71}
72
73
74void dMultiply1 (dReal *A, const dReal *B, const dReal *C, int p, int q, int r)

Callers 2

dInternalStepIsland_x1Function · 0.85
dTestSolveLCPFunction · 0.85

Calls

no outgoing calls

Tested by

no test coverage detected