点在多边形内的检测方法

实现了两种检测方法：射线法和投影法，投影法适合矩形和正方形

1.
//射线法：从点做射线，根据和多边形各边界交点的个数，判断是否在多边形内。
  TVector p0 = plynB.curr_p[0];      TVector p1 = plynB.curr_p[1];
  TVector p2 = plynB.curr_p[2];      TVector p3 = plynB.curr_p[3];
  int sum = 0 ;
  for( i=0 ; i <4; i++) 
  {
    TVector Ta = (p2-p1)*20;
    TVector Tb = plynB.curr_p[(i+1)%4]-plynB.curr_p[i] ;
 
    double a0 = intersection.X() ;
    double b0 = Ta.X() ;  double c0 = plynB.curr_p[i].X() ; double d0 = Tb.X() ;

    double a1 = intersection.Y() ;
    double b1 = Ta.Y() ;  double c1 = plynB.curr_p[i].Y() ; double d1 = Tb.Y() ;

    double u = (d1*c0-d0*c1-d1*a0+d0*a1) / (d1*b0 - d0*b1);
    double t = (b1*a0-b0*a1-b1*c0+b0*c1) / (b1*d0 - b0*d1);
    if( u >ZERO && t >ZERO && t < 1.0f)  //sum 记录交点个数
       sum ++ ;    
  }
     if( sum == 1 )  //交点个数为1 时，表示点在多边形内
  { 
    plyn_A.Vel = - plyn_A.Vel ; //相交的话，速度取反，物体返回
    return ;
  }

2.
//投影法：遍历主动面的各条线段,叉积和多边形发向存在同向，则点在多边形外
          TVector a =plynB.curr_p[1] - plynB.curr_p[0] ;
  TVector b =plynB.curr_p[3] - plynB.curr_p[0] ;
  TVector normal = a * b;  //平面法向

  //遍历主动面的各条线段,叉积和多边形发向存在同向，则点在多边形外
  for( int i = 0; i< 4 ; i++) 
  if( ((intersection -plynB.curr_p[i])*(plynB.curr_p[(i+1)%4] - plynB.curr_p[i])).dot(normal) > 0 )
     return  ; //点在面外，返回

 
     plyn_A.Vel = - plyn_A.Vel ; //相交的话，速度取反，物体返回