运行rf2o时报错,pose不能更新
程序员文章站
2022-07-12 12:43:41
...
[rf2o] ERROR: Eigensolver couldn’t find a solution. Pose is not updated
解决方案:
修改src/CLaserOdometry2D.cpp
292-298行修改成如下:
//Inner pixels
if ((u>1)&&(u<cols_i-2))
{
if (dcenter > 0.f)
if (std::isfinite(dcenter) && dcenter > 0.f)
{
float sum = 0.f;
float weight = 0.f;
316-322行修改成如下:
//Boundary
else
{
if (dcenter > 0.f)
if (std::isfinite(dcenter) && dcenter > 0.f)
{
float sum = 0.f;
float weight = 0.f;
推荐阅读