Lines Matching refs:currMatr
105 int currMatr;
108 for( currMatr = 0; currMatr < 3; currMatr++ )
113 p[i] = cvmGet(vectX,currMatr*12+i,0);
143 currMatr*numPoints*2+currProjPoint*2+j, 36+currProjPoint*4+i,
151 cvmSet(Jacobian,currMatr*numPoints*2+currProjPoint*2,currMatr*12+i,X[i]/piX[2]);//x' p1i
152 cvmSet(Jacobian,currMatr*numPoints*2+currProjPoint*2,currMatr*12+8+i,X[i]*tmp1);//x' p3i
155 cvmSet(Jacobian,currMatr*numPoints*2+currProjPoint*2+1,currMatr*12+4+i,X[i]/piX[2]);//y' p2i
156 cvmSet(Jacobian,currMatr*numPoints*2+currProjPoint*2+1,currMatr*12+8+i,X[i]*tmp2);//y' p3i
221 int currMatr;
226 for( currMatr = 0; currMatr < 3; currMatr++ )
233 cvmSet(&projMatrs[currMatr],i,j,val);
252 for( currMatr = 0; currMatr < 3; currMatr++ )
255 cvmMul(&projMatrs[currMatr],&point4D,&point3D);
257 cvmSet(resFunc,currMatr*numPoints*2 + currPoint*2, 0,point3D_dat[0]/z);
258 cvmSet(resFunc,currMatr*numPoints*2 + currPoint*2+1,0,point3D_dat[1]/z);
376 int currMatr;
377 for( currMatr = 0; currMatr < 3; currMatr++ )
381 cvmSet(observRes,currMatr*numPoints*2+i*2 ,0,cvmGet(projPoints[currMatr],0,i) );/* x */
382 cvmSet(observRes,currMatr*numPoints*2+i*2+1,0,cvmGet(projPoints[currMatr],1,i) );/* y */
387 for( currMatr = 0; currMatr < 3; currMatr++ )
392 cvmSet(vectorX0,currMatr*12+i,0,cvmGet(projMatrs[currMatr],i/4,i%4));
413 for( currMatr = 0; currMatr < 3; currMatr++ )
418 cvmSet(resultProjMatrs[currMatr],i/4,i%4,cvmGet(optimX,currMatr*12+i,0));