matlab中ICP点云匹配算法

时间:2016-07-15 10:52:17
【文件属性】:

文件名称:matlab中ICP点云匹配算法

文件大小:11KB

文件格式:RAR

更新时间:2016-07-15 10:52:17

ICP 点云数据 匹配算法

function [R1, t1] = reg(data1, data2, corr) M = data1(:,corr(:,1)); mm = mean(M,2); S = data2(:,corr(:,2)); ms = mean(S,2); Sshifted = [S(1,:)-ms(1); S(2,:)-ms(2); ]; Mshifted = [M(1,:)-mm(1); M(2,:)-mm(2); ]; b1 = Sshifted(1,:)*Mshifted(1,:)'+Sshifted(2,:)*Mshifted(2,:)'; b2 = -Sshifted(2,:)*Mshifted(1,:)'+Sshifted(1,:)*Mshifted(2,:)'; bb = (b1^2+b2^2)^0.5; c = b1/bb; s = b2/bb; R1 = [c -s s c]; t1 = mm - R1*ms;


【文件预览】:
ICP-matlab程序
----icp_2d.m(4KB)
----icp.m(711B)
----comparedata.mat(9KB)

网友评论

  • 赞~需要二维的,找了一堆三维的,新手又不会改,速度又慢不能实时匹配,还急着用,总算找到简单合适的代码了~~~
  • 有参考价值,能顺利跑通
  • 看起来有点困难,实用性不强
  • 还是有点用的~~~~
  • 有点用,谢谢楼主
  • 有点帮助。。。
  • 正在学习中~~
  • 正在学习,有点帮助
  • 在用着~谢谢楼主!学习了!