| 135 | } |
| 136 | |
| 137 | void ComputeProjectionCenter(const float R[9], const float T[3], float C[3]) { |
| 138 | const Eigen::Map<const Eigen::Matrix<float, 3, 3, Eigen::RowMajor>> R_m(R); |
| 139 | const Eigen::Map<const Eigen::Matrix<float, 3, 1>> T_m(T); |
| 140 | Eigen::Map<Eigen::Vector3f> C_m(C); |
| 141 | C_m = -R_m.transpose() * T_m; |
| 142 | } |
| 143 | |
| 144 | void RotatePose(const float RR[9], float R[9], float T[3]) { |
| 145 | Eigen::Map<Eigen::Matrix<float, 3, 3, Eigen::RowMajor>> R_m(R); |
no outgoing calls