求空间直线的交点.docVIP

因为一个小任务需要用到求空间直线交点的MATLAB函数和求空间中两个平面的相交线的函数，但是在网上找了一下没有，只好自己写了几个函数，自己觉得还能用，在这里给大家分享一下。 MATLAB求空间中的两个平面的相交线 function [flag,n,p] = PlanePlane2Line(n1,p1,n2,p2) %--------------------------------------------------------- % calulate the line shared by two intersecting plane % input: % n1 normal vector of plane one % p1 any point on plane one % n2 normal vector of plane two % p2 any point on plane two % % output: % flag whether the two planes are intersecting ( 1 or 0) % n the direction vector of the expected line % p any point in the expected line % % author: Lai Zhenzhou from Harbin Institute of Technology % email: laizhenzhou@126.com % date: 2014.1.16 %---------------------------------------------------------- if(~(isvector(n1) isvector(p1) isvector(n2) isvector(p2))) error(PlanePlane2Line:the parameter is not vector); end if((length(n1)~=3)||(length(p1)~=3)||(length(n2)~=3)||(length(p2)~=3)) error(PlanePlane2Line:the parameter is not 3d vector); end A = [n1(1) n1(2) n1(3);n2(1) n2(2) n2(3)]; if(rank(A)2) flag = 0; else flag = 1; end if(flag==1) % calculate the normal vector n = cross(n1,n2); c1 = [n1(1) n1(2) n1(3) -dot(n1,p1)]; c2 = [n2(1) n2(2) n2(3) -dot(n2,p2)]; % calculate the simplest Row echelon matrix temp1 = rref(A); temp2 = [1 2 3]; index(1) = find(temp1(1,:),1,first); % the first nonzero element index(2) = find(temp1(2,:),1,first); % the first nonzero element D = [A(:,index(1)) A(:,index(2))]; Y = [dot(n1,p1);dot(n2,p2)]; X = inv(D)*Y; for i=1:3 if(i~=index(1) i~=index(2)) index(3) = i; end end p(index(1)) = X(1); p(index(2)) = X(2); p(index(3)) = 0; else n=[]; p=[]; end %-----------for test------------------ % [flag n p] = PlanePlane2Line([1 2 3],[1 0 1],[2 3 4],[0 -1 0]) % [flag n p] = PlanePlane2Line([0 0 1],[0.5 0.5 0.5],[1