We read every piece of feedback, and take your input very seriously.
To see all available qualifiers, see our documentation.
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
`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`呢?
你好,请问feature.hpp中的cost函数是计算重投影误差的吗?为什么地图点z的归一化平面坐标是
,而不是
The text was updated successfully, but these errors were encountered:
No branches or pull requests
`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`呢?The text was updated successfully, but these errors were encountered: