纳金网

标题: 判断一点在一个三角形内的代码 [打印本页]
作者: 烟雨    时间: 2015-12-30 23:31
标题: 判断一点在一个三角形内的代码
  1. Vector3ForNew A(64.0f,0.0f,1.0f);//三角形定点坐标
  2.    Vector3ForNew B(0.0f,128.0f,1.0f);//三角形定点坐标
  3.    Vector3ForNew C(128.0f,128.0f,1.0f);//三角形定点坐标

  5.    for (int a=0;a<128;a++)
  6.    {
  7.       for (int b=0;b<128;b++)
  8.       {
  9.          COLORREF kcolor = GetPixel(test.GetDC(),a,b);
  10.          if (CLR_INVALID==kcolor)
  11.          {
  12.                    //获取像素颜色失败
  13.          }
  14.          else
  15.          {
  16.             float af = (float)a;
  17.             float bf = (float)b;
  18.             Vector3ForNew P(af,bf,1.0f);
  19.             if (PointinTriangle(A,B,C,P))
  20.             {
  21.                                 test.SetPixelRGB(a,b,255,0,0);//替换红色，让三角形为红色
  22.             }
  23.             else
  24.             {
  25.                 test.SetPixelRGB(a,b,0,0,0);//黑色
  26.             }
  27.          }
  28.       }
  29.    }
  30. bool UserDefinedMenu::PointinTriangle(Vector3ForNew A, Vector3ForNew B, Vector3ForNew C, Vector3ForNew P)
  31. {
  32.    Vector3ForNew v0 = C - A ;
  33.    Vector3ForNew v1 = B - A ;
  34.    Vector3ForNew v2 = P - A ;

  36.    float dot00 = v0.Dot(v0) ;
  37.    float dot01 = v0.Dot(v1) ;
  38.    float dot02 = v0.Dot(v2) ;
  39.    float dot11 = v1.Dot(v1) ;
  40.    float dot12 = v1.Dot(v2) ;

  42.    float inverDeno = 1 / (dot00 * dot11 - dot01 * dot01) ;

  44.    float u = (dot11 * dot02 - dot01 * dot12) * inverDeno ;
  45.    if (u < 0 || u > 1) // if u out of range, return directly
  46.    {
  47.       return false ;
  48.    }

  50.    float v = (dot00 * dot12 - dot01 * dot02) * inverDeno ;
  51.    if (v < 0 || v > 1) // if v out of range, return directly
  52.    {
  53.       return false ;
  54.    }

  56.    return u + v <= 1 ;
  57. }
  58. // 3D vector
  59. class Vector3ForNew
  60. {
  61. public:
  62.    Vector3ForNew(float fx, float fy, float fz)
  63.       :x(fx), y(fy), z(fz)
  64.    {
  65.    }

  67.    // Subtract
  68.    Vector3ForNew operator - (const Vector3ForNew& v) const
  69.    {
  70.       return Vector3ForNew(x - v.x, y - v.y, z - v.z) ;
  71.    }

  73.    // Dot product
  74.    float Dot(const Vector3ForNew& v) const
  75.    {
  76.       return x * v.x + y * v.y + z * v.z ;
  77.    }

  79.    // Cross product
  80.    Vector3ForNew Cross(const Vector3ForNew& v) const
  81.    {
  82.       return Vector3ForNew(
  83.          y * v.z - z * v.y,
  84.          z * v.x - x * v.z,
  85.          x * v.y - y * v.x ) ;
  86.    }

  88. public:
  89.    float x, y, z ;
  90. };
复制代码




欢迎光临 纳金网 (http://go.narkii.com/club/) Powered by Discuz! X2.5