| 122 | } |
| 123 | |
| 124 | float ProjectPointDepth(const float* P, const Eigen::Vector3f& point) { |
| 125 | const Eigen::Map<const Eigen::Matrix<float, 3, 4, Eigen::RowMajor>> P_m(P); |
| 126 | const Eigen::Vector4f ph(point.x(), point.y(), point.z(), 1.0f); |
| 127 | return (P_m.row(2) * ph)(0, 0); |
| 128 | } |
| 129 | |
| 130 | Eigen::Vector3f ComputeCameraCenter(const float* R, const float* T) { |
| 131 | const Eigen::Map<const Eigen::Matrix<float, 3, 3, Eigen::RowMajor>> R_m(R); |