空间中直线及三角面片求交.docVIP

class CVector??{public:?union?{??float vec[3];??struct? { float x,y,z;};?};} class CCommonTools??{public:?CCommonTools();?virtual ~CCommonTools();public:?static bool ValidPoint(CVector LinePoint, CVector LineV,?????????????????????????????????? CVector TrianglePoint1, CVector TrianglePoint2,?CVector TrianglePoint3,CVector result);?static float Area(float a, float b, float c);?static float Distance(CVector p1, CVector p2);}; /////////////////////////////// CCommonTools::CCommonTools(){ } CCommonTools::~CCommonTools(){ }//计算p1到p2的距离的平方float CCommonTools::Distance(CVector p1, CVector p2){?float dist;?dist = ((p2.x-p1.x)*(p2.x-p1.x)?? + (p2.y-p1.y)*(p2.y-p1.y)?? + (p2.z-p1.z)*(p2.z-p1.z));?return (float)sqrt(dist);}//利用海伦公式求变成为a,b,c的三角形的面积float CCommonTools::Area(float a, float b, float c){?float s = (a+b+c)/2;?return (float)sqrt(s*(s-a)*(s-b)*(s-c));}bool CCommonTools::ValidPoint(CVector LinePoint1, CVector LinePoint2, CVector TrianglePoint1, CVector TrianglePoint2,CVector TrianglePoint3,CVector result){? //三角形所在平面的法向量? CVector TriangleV;? //三角形的边方向向量? CVector VP12, VP13;? //直线与平面的交点? CVector CrossPoint;? //平面方程常数项? float TriD;? CVector LineV = LinePoint2 - LinePoint1;? /*-------计算平面的法向量及常数项-------*/? //point1-point2? VP12.x = TrianglePoint2.x - TrianglePoint1.x;? VP12.y = TrianglePoint2.y - TrianglePoint1.y;? VP12.z = TrianglePoint2.z - TrianglePoint1.z;? //point1-point3? VP13.x = TrianglePoint3.x - TrianglePoint1.x;? VP13.y = TrianglePoint3.y - TrianglePoint1.y;? VP13.z = TrianglePoint3.z - TrianglePoint1.z;? //VP12xVP13? TriangleV.x = VP12.y*VP13.z - VP12.z*VP13.y;? TriangleV.y = -(VP12.x*VP13.z - VP12.z*VP13.x);? TriangleV.z= VP12.x*VP13.y - VP12.y*VP13.x;? //计算常数项? TriD = -(TriangleV.x*TrianglePoint1.x??? + TriangleV.y*TrianglePoint1.y??? + TriangleV.z*TrianglePoint1.z);? /*-------求解直线与平面的交点坐标---------*/? /* 思路：?? *???? 首先将直线方程转换为参数方程形式，然后代入平面方程，求得参数t，?? * 将t代入直线的参数方程即可求出交点坐标? */? float tempU, te