How can i create xyz coordinant from pan-tilt system angles.

Question

Aui 2018-11-2

0
链接

此问题的直接链接

https://ww2.mathworks.cn/matlabcentral/answers/427558-how-can-i-create-xyz-coordinant-from-pan-tilt-system-angles

评论： Aui 2018-11-8

Hello guys, I have 3 data, First servo angle for pan, second servo angle for tilt and measurement from the laser. If I can able to get xyz points, so I can use it as meshing point to 3D mapping by using software such as CloudCompare or MeshLab.

2 个评论
显示无隐藏无

Jim Riggs 2018-11-2

Hard to understand what you want. Try drawing a picture to illustrate the problem.

Aui 2018-11-5

编辑：KSSV 2018-11-5

Dear Jim, https://www.youtube.com/watch?v=kJW9Uy4j-6k My project is as same as the project in this video.

I have 2 angle from servos and 1 data from laser meter. For mapping i need to get xyz coordinant from the datas

I hope you understand me now.

请先登录，再进行评论。

请先登录，再回答此问题。

Answer 1

Jim Riggs 2018-11-7

0
链接

此回答的直接链接

https://ww2.mathworks.cn/matlabcentral/answers/427558-how-can-i-create-xyz-coordinant-from-pan-tilt-system-angles#answer_345575

在 MATLAB Online 中打开

It seems that you want to convert from spherical coordinates to Cartesian coordinates. You have pan angle (azimuth) and a tile angle (elevation), and the "1 data from laser meters" I assume that this is the range (or radius) in meters.

Matlab has a function which will perform this conversion called sph2cart:

[x,y,z] = sph2cart(azimuth,elevation,radius);

This function performs the following transformation:

x = radius .* cos(elevation) .* cos(azimuth);
y = radius .* cos(elevation) .* sin(azimuth);
z = radius .* sin(elevation);

5 个评论
显示 3更早的评论隐藏 3更早的评论

Aui 2018-11-7

在 MATLAB Online 中打开

Dear Jim, Thanks for the feedback. I already have used that function. There is something that I never understand. Here is my code.

 clc
clear
servo1= [1:180]; %from 1° to 180° for pan 
servo2= zeros(1,180);
servo2= servo2+30; % constant 30° for tilt
length= zeros(1,180);
length=length + 500; % constant measurement from laser sensor which is 500mm
[x,y,z] = sph2cart(servo1,servo2,length);
plot3(x,y,z);
  end

As a result, it should be a circle as expected since the measurement is constant. There is no problem.

But when i wanted to get the rectangular shape. Think of it as I am scanning a room. Here is the code about it.

clc
clear
servo1= [1:180]; %from 1° to 180° for pan 
servo2= zeros(1,180);
servo2= servo2+30; % constant 30° for tilt
a=zeros(1,45);
a=a+200;
b=zeros(1,90);
b=b+500;
length=[a,b,a]; % first 45 datas is 200mm, then 500mm, last datas are also 200mm
[x,y,z] = sph2cart(servo1,servo2,length);
plot3(x,y,z);
end
When I plot to xyz points, it shows me an unexpected result.

I expecting that it should be rectangular. Why i get this shape as a result?

Jim Riggs 2018-11-7

编辑：Jim Riggs 2018-11-7

在 MATLAB Online 中打开

I am not sure what you are asking. If you have pan/tilt/range measurements, you can convert them directly to X/Y/Z coordinates. Just make sure that your pan/tilt angles are in radians when you call the sph2cart function. Or, you can write your own function using the three equations, above, and use the sind and cosd functions to operate in your data in degrees.

function [x, y, z] = my_sph2cart(pan,tilt,range)
  x = range .* cosd(tilt) .* cosd(pan);
  y = range .* cosd(tilt) .* sind(pan);
  z = range .* sind(tilt);
end