• <ins id="pjuwb"></ins>
    <blockquote id="pjuwb"><pre id="pjuwb"></pre></blockquote>
    <noscript id="pjuwb"></noscript>
          <sup id="pjuwb"><pre id="pjuwb"></pre></sup>
            <dd id="pjuwb"></dd>
            <abbr id="pjuwb"></abbr>

            cc

              C++博客 :: 首頁 :: 新隨筆 :: 聯系 :: 聚合  :: 管理 ::
              38 隨筆 :: 14 文章 :: 21 評論 :: 0 Trackbacks

            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, tempD;  //臨時變量
              tempU = TriangleV.x*LinePoint1.x + TriangleV.y*LinePoint1.y
                + TriangleV.z*LinePoint1.z + TriD;
              tempD = TriangleV.x*LineV.x + TriangleV.y*LineV.y + TriangleV.z*LineV.z;
              //直線與平面平行或在平面上
              if(tempD == 0.0)
              {
              // printf("The line is parallel with the plane.\n");
               return false;
              }
              //計算參數t
              float t = -tempU/tempD;
              //計算交點坐標
              CrossPoint.x = LineV.x*t + LinePoint1.x;
              CrossPoint.y = LineV.y*t + LinePoint1.y;
              CrossPoint.z = LineV.z*t + LinePoint1.z;
              /*----------判斷交點是否在三角形內部---------*/

              //計算三角形三條邊的長度
              float d12 = Distance(TrianglePoint1, TrianglePoint2);
              float d13 = Distance(TrianglePoint1, TrianglePoint3);
              float d23 = Distance(TrianglePoint2, TrianglePoint3);
              //計算交點到三個頂點的長度
              float c1 = Distance(CrossPoint, TrianglePoint1);
              float c2 = Distance(CrossPoint, TrianglePoint2);
              float c3 = Distance(CrossPoint, TrianglePoint3);
              //求三角形及子三角形的面積
              float areaD = Area(d12, d13, d23);  //三角形面積
              float area1 = Area(c1, c2, d12);    //子三角形1
              float area2 = Area(c1, c3, d13);    //子三角形2
              float area3 = Area(c2, c3, d23);    //子三角形3
              //根據面積判斷點是否在三角形內部
              if(fabs(area1+area2+area3-areaD) > 0.001)
              {
              return false;
              }


              result = CrossPoint;
              return true;
            }

            這幾天同學問我如何判斷空間中的線段和三角面片是否相交,我想這個也許對其他人也有點用處。

            上面的代碼是判斷兩點構成的直線和三點構成的面片是否相交,要判斷線段的話,需要再判斷交點是否在線段的兩個端點之間:  交點和兩個端點可以形成兩個向量,判斷這兩個向量的方向即可。

            posted on 2008-07-17 09:26 醒目西西 閱讀(2443) 評論(0)  編輯 收藏 引用
            亚洲国产精品热久久| 无码任你躁久久久久久| 狠狠色丁香久久婷婷综合五月| 亚洲精品乱码久久久久久蜜桃图片 | 丁香色欲久久久久久综合网| 国产精品99久久免费观看| 久久综合久久综合久久| 久久91精品国产91久| 国产精品久久99| 色婷婷狠狠久久综合五月| 精品永久久福利一区二区| 亚洲日韩欧美一区久久久久我| AV无码久久久久不卡蜜桃| 精品久久久久久久国产潘金莲| 国产欧美久久久精品| 久久精品免费一区二区| 91久久成人免费| 97久久精品人妻人人搡人人玩 | 影音先锋女人AV鲁色资源网久久 | 四虎国产精品免费久久| 久久夜色精品国产噜噜噜亚洲AV | 久久久久人妻一区精品色| 色婷婷久久久SWAG精品| 久久97久久97精品免视看| 四虎国产永久免费久久| 久久精品一本到99热免费| 久久99久久99精品免视看动漫| 久久久久久久久久免免费精品| 国产69精品久久久久9999| 欧美综合天天夜夜久久| 夜夜亚洲天天久久| 国产精品免费久久久久影院| 亚洲狠狠久久综合一区77777 | 精品国产一区二区三区久久蜜臀| 久久久精品人妻一区二区三区蜜桃 | 亚洲国产天堂久久综合网站| 国产精品久久久久影院嫩草| 国产精品久久久久久一区二区三区| 亚洲精品蜜桃久久久久久| 国产Av激情久久无码天堂| 久久婷婷综合中文字幕|