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
 

 

  • 0
    点赞
  • 0
    收藏
    觉得还不错? 一键收藏
  • 0
    评论
评论
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

当前余额3.43前往充值 >
需支付:10.00
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包
实付
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明:

1.余额是钱包充值的虚拟货币,按照1:1的比例进行支付金额的抵扣。
2.余额无法直接购买下载,可以购买VIP、付费专栏及课程。

余额充值