Lines Matching refs:rz
531 double rx, ry, rz, theta; in cvRodrigues2() local
544 rz = src->data.fl[step*2]; in cvRodrigues2()
550 rz = src->data.db[step*2]; in cvRodrigues2()
552 theta = sqrt(rx*rx + ry*ry + rz*rz); in cvRodrigues2()
574 rx *= itheta; ry *= itheta; rz *= itheta; in cvRodrigues2()
576 double rrt[] = { rx*rx, rx*ry, rx*rz, rx*ry, ry*ry, ry*rz, rx*rz, ry*rz, rz*rz }; in cvRodrigues2()
577 double _r_x_[] = { 0, -rz, ry, rz, 0, -rx, -ry, rx, 0 }; in cvRodrigues2()
590 double drrt[] = { rx+rx, ry, rz, ry, 0, 0, rz, 0, 0, in cvRodrigues2()
591 0, rx, 0, rx, ry+ry, rz, 0, rz, 0, in cvRodrigues2()
592 0, 0, rx, 0, 0, ry, rx, ry, rz+rz }; in cvRodrigues2()
598 double ri = i == 0 ? rx : i == 1 ? ry : rz; in cvRodrigues2()
610 double R[9], U[9], V[9], W[3], rx, ry, rz; in cvRodrigues2() local
636 rz = R[3] - R[1]; in cvRodrigues2()
638 s = sqrt((rx*rx + ry*ry + rz*rz)*0.25); in cvRodrigues2()
648 rx = ry = rz = 0; in cvRodrigues2()
656 rz = theta*sqrt(MAX(t,0.))*(R[2] < 0 ? -1. : 1.); in cvRodrigues2()
695 0, 0, vth, rz, 0, in cvRodrigues2()
702 0, 0, theta, rz*vth in cvRodrigues2()
721 rx *= vth; ry *= vth; rz *= vth; in cvRodrigues2()
728 dst->data.fl[step*2] = (float)rz; in cvRodrigues2()
734 dst->data.db[step*2] = rz; in cvRodrigues2()