turtlezhong / msckf_mono Goto Github PK

@ @TurtleZhong

`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`呢？

I can see stereoCallback being registed. I am a bit confused which one is the right folder

您好 钟老师，感谢您的杰出工作。
我是个初学者，想请教一下msckf 调试一般有哪些技巧呢？用vim 打印调试吗

您好，最近我尝试复现LIC-Fusion中的一些内容，但是存在很多问题，您知道还有什么融合激光信息的MSCKF开源项目吗？