Searched refs:R_trans (Results 1 – 1 of 1) sorted by relevance
293 matd_t* R_trans = matd_multiply(R_1_prime, R_z); in fix_pose_ambiguities() local294 double sin_gamma = -MATD_EL(R_trans, 0, 1); in fix_pose_ambiguities()295 double cos_gamma = MATD_EL(R_trans, 1, 1); in fix_pose_ambiguities()301 double sin_beta = -MATD_EL(R_trans, 2, 0); in fix_pose_ambiguities()302 double cos_beta = MATD_EL(R_trans, 2, 2); in fix_pose_ambiguities()304 matd_destroy(R_trans); in fix_pose_ambiguities()