ndt histogram_direction

Posted 岁寒然后知松柏之后凋也!

tags:

篇首语:本文由小常识网(cha138.com)小编为大家整理,主要介绍了ndt histogram_direction相关的知识,希望对你有一定的参考价值。

histogram_direction

N_FLAT_BINS=40;
dlong = pi*(3-sqrt(5.0));  % ~2.39996323
dz    = 2.0/N_FLAT_BINS;
longitude = 0;
z    = 1 - dz/2;
directions=zeros(3,N_FLAT_BINS);
for  k = 1:N_FLAT_BINS
    r = sqrt(1-z*z);
    v=[1*cos(longitude)*r 1*sin(longitude)*r z]\';
    directions(:,k)=v;
    z = z - dz;
    longitude = longitude + dlong;
end

figure(1)
plot3(directions(1,:),directions(2,:),directions(3,:),\'r.\',0,0,0,\'b.\'), hold on, axis equal
for  k = 1:N_FLAT_BINS-1
    plot3([directions(1,k) 0],[directions(2,k) 0],[directions(3,k) 0],\'y-\',\'LineWidth\',1);
    plot3([directions(1,k) directions(1,k+1)],[directions(2,k) directions(2,k+1)],[directions(3,k) directions(3,k+1)],\'LineWidth\',1);
end

  

 

以上是关于ndt histogram_direction的主要内容,如果未能解决你的问题,请参考以下文章

3d激光雷达开发(ndt匹配)

编译依赖ndt_gpu库的包,遇到Eigen报错

点云NDT配准方法介绍

NDT 算法和一些常见配准算法

点云库PCL:NDT配准时出现容器出限的问题及解决

NDT(Normal Distributions Transform)算法原理与公式推导