321型正交位移測量系統,已知某座標系位姿及六根直線表達式,求直線與座標系平面的交點

function M=L_for_M(T,L)
% T爲齊次座標變換矩陣
% L爲六直線組,6*6向量
% M爲直線與座標系平面的六交點組,6*3向量
I=[T(1,4) T(2,4) T(3,4) T(1,1) T(2,1) T(3,1) T(1,2) T(2,2) T(3,2)];%I面表達式
II=[T(1,4) T(2,4) T(3,4) T(1,3) T(2,3) T(3,3) T(1,1) T(2,1) T(3,1)];%II面表達式
III=[T(1,4) T(2,4) T(3,4) T(1,2) T(2,2) T(3,2) T(1,3) T(2,3) T(3,3)];%III面表達式
for k=1:3
    M(k,:)=intersectPlaneLine(I, L(k,:));%I面與直線交點座標
end
for k=4:5
    M(k,:)=intersectPlaneLine(II, L(k,:));%II面與直線交點座標
end
for k=6:6
    M(k,:)=intersectPlaneLine(III, L(k,:));%III面與直線交點座標
end
 

 

發表評論
所有評論
還沒有人評論,想成為第一個評論的人麼? 請在上方評論欄輸入並且點擊發布.
相關文章