D | p3p.cpp | 59 double mu0, double mv0, double X0, double Y0, double Z0, in solve() argument 66 int n = solve(Rs, ts, mu0, mv0, X0, Y0, Z0, mu1, mv1, X1, Y1, Z1, mu2, mv2, X2, Y2, Z2); in solve() 96 double mu0, double mv0, double X0, double Y0, double Z0, in solve() argument 120 distances[1] = sqrt( (X0 - X2) * (X0 - X2) + (Y0 - Y2) * (Y0 - Y2) + (Z0 - Z2) * (Z0 - Z2) ); in solve() 121 distances[2] = sqrt( (X0 - X1) * (X0 - X1) + (Y0 - Y1) * (Y0 - Y1) + (Z0 - Z1) * (Z0 - Z1) ); in solve() 148 if (!align(M_orig, X0, Y0, Z0, X1, Y1, Z1, X2, Y2, Z2, R[nb_solutions], t[nb_solutions])) in solve() 262 double X0, double Y0, double Z0, in align() argument 272 C_start[2] = (Z0 + Z1 + Z2) / 3; in align() 279 …s[2 * 3 + j] = (Z0 * M_end[0][j] + Z1 * M_end[1][j] + Z2 * M_end[2][j]) / 3 - C_end[j] * C_start[2… in align()
|