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
 

 

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