Skip to content
New issue

Have a question about this project? Sign up for a free GitHub account to open an issue and contact its maintainers and the community.

By clicking “Sign up for GitHub”, you agree to our terms of service and privacy statement. We’ll occasionally send you account related emails.

Already on GitHub? Sign in to your account

你好,请问feature.hpp中的cost函数定义是重投影误差吗? #5

Open
bereze opened this issue Jul 9, 2021 · 0 comments

Comments

@bereze
Copy link

bereze commented Jul 9, 2021

`void Feature::cost(const Eigen::Isometry3d& T_c0_ci, const Eigen::Vector3d& x,
const Eigen::Vector2d& z, double& e) const {
// Compute hi1, hi2, and hi3 as Equation (37).
const double& alpha = x(0);
const double& beta = x(1);
const double& rho = x(2);

Eigen::Vector3d h = T_c0_ci.linear() * Eigen::Vector3d(alpha, beta, 1.0) +
rho * T_c0_ci.translation();
double& h1 = h(0);
double& h2 = h(1);
double& h3 = h(2);

// Predict the feature observation in ci frame.
Eigen::Vector2d z_hat(h1 / h3, h2 / h3);

// Compute the residual.
e = (z_hat - z).squaredNorm();
return;
} 你好,请问feature.hpp中的cost函数是计算重投影误差的吗?为什么地图点z的归一化平面坐标是R * (alpha,beta,1.0)+rhot,而不是R(alpha,beta,rho)+t`呢?

Sign up for free to join this conversation on GitHub. Already have an account? Sign in to comment
Labels
None yet
Projects
None yet
Development

No branches or pull requests

1 participant