https://github.com/JStech/ICP
Raw File
Tip revision: 0490588c4d75366091967b44617c482900cb2a0f authored by John Stechschulte on 06 June 2019, 16:26:21 UTC
Updated README.md to cite ICRA
Tip revision: 0490588
plot_icp_seq.m
function [T] = plot_icp_seq(clouds, tfs, ds)
  if 0==exist('ds')
    ds = 1;
  end
  figure;
  hold on
  T = eye(4);
  colors = {'red', 'green', 'blue'};

  pcshow(clouds{1}(1:ds:end,1:3), colors{mod(0, size(colors, 2))+1}, 'MarkerSize', 1)
  for i=1:size(tfs, 2)
    T = T*tfs{i};
    cloud = (T*clouds{i+1}')';
    pcshow(cloud(1:ds:end,1:3), colors{mod(i, size(colors, 2))+1}, 'MarkerSize', 1)
  end
  hold off
end
back to top