1. 程式人生 > >Velodyne 線性激光雷達數據合成

Velodyne 線性激光雷達數據合成

字母 輸入 分享 image atl 表示 技術分享 cos 旋轉

坐標系旋轉

技術分享圖片

如果想用字母表示角度,有兩個方法:

1. 用三角函數sind(θ4)、cosd(θ4)、tand(θ4)、atand(θ4)進行表示,註意:θ4在輸入時是角度,只是沒有度數特有的符號(°)而已。

2. 用deg2rad將角度轉換為弧度。45度就是45/180*pi,60度就是60/180*pi。pi=3.1415。

技術分享圖片

clear
m = csvread(‘zero_1.csv‘, 2, 0);
n = csvread(‘one_1.csv‘, 2, 0);
for i=1:1:3
    m1(:,i)=m(:,i);
    n1(:,i)=n(:,i);
end
k=36/180*pi;
k1=1/180*pi;
trans=[cos(k) sin(k) 0;-sin(k) cos(k) 0;0 0 1];
trans1=[01 0 0;0 cos(k1) sin(k1);0 -sin(k1) cos(k1)];
trans2=[cos(-k) sin(-k) 0;-sin(-k) cos(-k) 0;0 0 1];
tmp=(trans2*trans1*trans*n1‘)‘;
tmp=[tmp;m1];

scatter3(tmp(:,1),tmp(:,2),tmp(:,3),1)
%scatter3(m(:,1),m(:,2),m(:,3),1)
%scatter3(n(:,1),n(:,2),n(:,3),1)

  

Velodyne 線性激光雷達數據合成