Cocos2d-x教程-三维物体OBB碰撞检测算法

发表于2015-12-19
评论0 4.9k浏览

 在上一篇文章中讲解了AABB包围盒碰撞检测的原理,并在文章末尾提到了Cocos2d-x 3.3beta0版本中小乌龟碰撞检测的例子,这个例子使用的并非是AABB碰撞检测,而是比AABB包围盒更加精确的OBB包围盒的碰撞检测方法,本篇文章将对OBB包围盒及其碰撞检测方法进行介绍。


1. OBB包围盒

       OBB(Oriented Bounding Box)包围盒也被称作有向包围盒或定向包围盒,它会随着物体的移动、缩放、旋转。简单来说,它就是一个能够旋转的AABB包围盒。在Cocos2d-x中使用过物理引擎的开发者一定见过当我们在物理世界中创建一个物体并开启调试模式时,这个物体会被红色的矩形包围,当物体做平移或旋转时,这个红色矩形也会做同样的操作,这个红色矩形正是该物体的OBB包围盒。如图1-1所示:

      
图1-1
       
       相对于AABB包围盒来讲,OBB在碰撞精度上要高于AABB,但是精确度的提高同时带来的就是效率的降低,OBB的算法无疑是要比AABB复杂的,同样内存消耗也会更大,这个问题我们可以从OBB的表达式来得到结论。

      OBB包围盒的表达式:


       表达一个AABB包围盒或OBB包围盒都有若干种方式,但是无疑需要选中里面最优的一种。对于AABB来说,通常只要使用两个顶点的坐标信息标识一个AABB包围盒就可以了,其它的顶点信息都可以通过计算得出。但是对于OBB包围盒的表达方式只有两点信息显然是不够的。

       想要唯一标识一个OBB包围盒我们大概会想到,使用8个顶点的集合、6个面的集合、1个顶点和3各彼此正交的边向量,又或者是1个中心点、1个旋转矩阵和3个1/2边长(注:一个旋转矩阵包含了三个旋转轴,若是二维的OBB包围盒则是一个中心点,两个旋转轴,两个1/2边长)。

      上述最后一种方法就是最常用的方法,下面来看一段Cocos2d-x 3.3beta0中CCOBB.h中的代码:
       
  1. Vec3 _center;   // 中心点  
  2. /* 
  3.   以下三个变量为正交单位向量, 
  4.   定义了当前OBB包围盒的x,y,z轴 
  5.   用于计算矢量投影 
  6.  */  
  7. Vec3 _xAxis;    // 包围盒x轴方向单位矢量  
  8. Vec3 _yAxis;    // 包围盒y轴方向单位矢量  
  9. Vec3 _zAxis;    // 包围盒z轴方向单位矢量  
  10. Vec3 _extents;  // 3个1/2边长,半长、半宽、半高  

       Cocos2d-x 3.0beta0在CCOBB.h中定义了五个成员变量,每一个数据类型都是一个三维向量,包含了3个浮点数。也就是说,表达一个OBB包围盒需要15个float类型的变量,占用60个字节,然而表示一个AABB包围盒仅需要两个顶点,24个字节,从这一点上来说,OBB的内存消耗算很高了。

       一种减少开销的方案是:只存储旋转矩阵的两个轴,只是在测试时利用叉积计算第三个轴,这样可以减少CPU操作开销并节省3个浮点数分量,降低20%内存消耗。


      OBB包围盒的创建:

       如何用一个高效的算法构建一个紧密包围的OBB包围盒或是AABB包围盒是一个很复杂的问题,因为不同的形状物体的包围是不同的,这里我们不去探讨构建OBB包围盒的原理,只了解一下Cocos2d-x 3.3beta0 中为我们提供的构建方法。
       在Cocos2d-x 中使用了两种方法去计算OBB,第一种方法是一种简化的OBB构建算法,由一个AABB包围盒来确定最终OBB包围盒,另外一种方法是通过协方差矩阵来确定一个方向包围盒(实际上无论是AABB包围盒还是OBB包围盒,真正的难点便在于包围盒的构建上)。

       在Cocos2d-x中第一种方法用起来更为简单一些,例如:
  1. AABB aabb = _sprite->getAABB();//获取一个Sprite3D对象的aabb包围盒  
  2. OBB  _obbt = OBB(aabb);//创建obb包围盒  


2. OBB包围盒的碰撞检测方法

       OBB包围盒的碰撞检测方法常采用的是分离轴定理,首先简单说明一下分离轴定理(separating axis theorem),通过分离轴定理我们可以得到如下结论:
      如果能找到一个轴,两个凸形状在该轴上的投影不重叠,则这两个形状不相交。如果这个轴不存在,并且那些形状是凸形的,则可以确定两个形状相交(凹形不适用,比如月牙形状,即使找不到分离轴,两个月牙形也可能不相交)。
      这个定理也可以这样理解,如果能找到一条直线,令包围盒A完全在直线的一边,包围盒B完全在另一边,则两包围盒不重叠。而这条直线便成为分离线(在三维世界中被称为分离面),并且一定垂直于分离轴。

      这里我们还是先来用二维世界中的OBB来进行演示,明白其中原理之后三维物体的OBB便十分容易理解了,如图2-1所示:
      
图2-1

       在图2-1中,针对某一分离轴L,如果包围盒A与包围盒B在轴L上的投影的半径和小于包围盒中心点间距在L的投影距离,那么包围盒A与包围盒B处于分离状态。使用运算式来表达就是:|T * L|>rA + rB。在Cocos2d-x 3.3beta0中验证相交时采用的并非这个方法,Cocos2d-x选用的方法是,取物体A及物体B的最大点和最小点的投影坐标,然后比较A的最大点与B的最小点,B的最小点与A的最大点。注意,尽管这是一个二维图像,但是实际上三维的图面体在分离轴上的投影跟二维的原理是一样的,都是一个线段。
      
       现在知道了分离轴定理的原理,下面则是如何选取分离轴。由于潜在的分离轴可能存在无数种,所以我们并非去要逐个验证,而是选取几个可测试的轴即可。例如Cocos2d-x中所选用的OBB包围盒的凸面体均为长方体,我们就以长方体的碰撞为例,两个长方体的碰撞可以将其归结为以下几种组合:面-面碰撞、面-边碰撞、边-边碰撞(顶点视为边的一部分)。所以实际上在取分离轴的时候,只需要分别取第一个包围盒的3个坐标轴,第二个包围盒的3个坐标轴,以及垂直于某一轴的9个轴(其他的分离轴都是跟这15个分离轴中的某一个轴平行的轴,投影所得线段值都一样,无需再验证)。

       这里再解释以下什么是垂直于某一轴的9个轴,具体的做法就是,首先取包围盒A的x轴方向的某一边矢量,再取包围盒B的x轴方向的某一边矢量,对两个矢量做叉积,求出一个垂直于A的矢量与B的矢量的方向矢量,这个结果就是需要使用的分离轴。按照这种做法,取A的x轴方向的边矢量分别与B的三个轴方向的边矢量做叉积,再取A的y轴方向与B的三个轴方向的边矢量做叉积,再取A的z轴方向的边矢量与B的三个轴方向的边矢量做叉积,结果一共3*3个分离轴。如图2-2所示:

图2-2

      图中的顶点顺序是按照Cocos2d-x中定义的OBB包围盒的顶点顺序定义的。图中的x代表的就是包围盒的x轴方向边的矢量(注意这里写的是矢量,不是x,y,z坐标轴),当然这个方向的矢量有无数个,我们只需取一个代表性的用来计算叉积即可。

       最后在Cocos2d-x 3.3beta0版本中的OBB碰撞检测函数 bool OBB::intersects(const OBB& box) const 中遇到了一点小问题,在最后的3*3边矢量求分离轴的时候2d-x中貌似调用错了方法,仍然你调用的是取三个坐标轴做分离轴,笔者下面做了一些修改,最后附上源码。
      
       CCOBB.h代码如下:
  1. #ifndef __CC_OBB_H__  
  2. #define __CC_OBB_H__  
  3.   
  4. #include "CCAABB.h"  
  5. #include "3d/3dExport.h"  
  6.   
  7. NS_CC_BEGIN  
  8.   
  9. class CC_3D_DLL OBB  
  10. {  
  11. public:  
  12.     OBB();//默认构造函数  
  13.   
  14.     /* 
  15.      * 构造函数 根据一个AABB包围盒初始化一个OBB包围盒 
  16.      */  
  17.     OBB(const AABB& aabb);  
  18.       
  19.     /* 
  20.      * 构造函数 根据点信息初始化一个OBB包围盒 
  21.      */  
  22.     OBB(const Vec3* verts, int num);  
  23.       
  24.     /* 
  25.      * 判断点是否在一个OBB包围盒内 
  26.      */  
  27.     bool containPoint(const Vec3& point) const;  
  28.   
  29.     /* 
  30.      * 指定OBB各成员变量的值 
  31.      */  
  32.     void set(const Vec3& center, const Vec3& _xAxis, const Vec3& _yAxis, const Vec3& _zAxis, const Vec3& _extents);  
  33.       
  34.     /* 
  35.      * 复位函数 将当前OBB对象所占用的内存块置零 
  36.      */   
  37.     void reset();  
  38.   
  39.     /* 面向包围盒z轴负方向 
  40.      * verts[0] : 左上点坐标 
  41.      * verts[1] : 左下点坐标 
  42.      * verts[2] : 右下点坐标 
  43.      * verts[3] : 右上点坐标 
  44.      * 
  45.      * 面向包围盒z轴正方向 
  46.      * verts[4] : 右上点坐标 
  47.      * verts[5] : 右下点坐标 
  48.      * verts[6] : 左下点坐标 
  49.      * verts[7] : 左上点坐标 
  50.      */  
  51.     void getCorners(Vec3* verts) const;  
  52.       
  53.     /* 
  54.      *检测是否和其他OBB盒碰撞 
  55.      */  
  56.     bool intersects(const OBB& box) const;  
  57.       
  58.     /** 
  59.      * 由给定的变换矩阵变换OBB包围盒 
  60.      */  
  61.     void transform(const Mat4& mat);  
  62.       
  63. protected:  
  64.     /* 
  65.      * 将点投影到目标轴 
  66.      */  
  67.     float projectPoint(const Vec3& point, const Vec3& axis) const;  
  68.       
  69.     /* 
  70.      * 计算最大和最小投影值 
  71.      */  
  72.     void getInterval(const OBB& box, const Vec3& axis, float &min, float &max) const;  
  73.       
  74.     /* 
  75.      * 取边的矢量 获取分离轴使用 
  76.      */  
  77.     Vec3 getEdgeDirection(int index) const;  
  78.       
  79.     /* 
  80.      * 取面的方向矢量 获取分离轴时使用 
  81.      */  
  82.     Vec3 getFaceDirection(int index) const;  
  83.   
  84. public:  
  85.     Vec3 _center;   // 中心点  
  86.     /* 
  87.       以下三个变量为正交单位向量, 
  88.       定义了当前OBB包围盒的x,y,z轴 
  89.       用于计算矢量投影 
  90.      */  
  91.     Vec3 _xAxis;    // 包围盒x轴方向单位矢量  
  92.     Vec3 _yAxis;    // 包围盒y轴方向单位矢量  
  93.     Vec3 _zAxis;    // 包围盒z轴方向单位矢量  
  94.     Vec3 _extents;  // 3个1/2边长,半长、半宽、半高  
  95. };  
  96.   
  97. NS_CC_END  
  98.   
  99. #endif  

       CCOBB.cpp代码如下:
  1. #include "3d/CCOBB.h"  
  2.   
  3. NS_CC_BEGIN  
  4.   
  5. #define ROTATE(a,i,j,k,l) g=a.m[i + 4 * j]; h=a.m[k + 4 * l]; a.m[i + 4 * j]=(float)(g-s*(h+g*tau)); a.m[k + 4 * l]=(float)(h+s*(g-h*tau));  
  6.   
  7. //生成协方差矩阵  
  8. static Mat4 _getConvarianceMatrix(const Vec3* vertPos, int vertCount)  
  9. {  
  10.     int i;  
  11.     Mat4 Cov;  
  12.   
  13.     double S1[3];  
  14.     double S2[3][3];  
  15.   
  16.     S1[0] = S1[1] = S1[2] = 0.0;  
  17.     S2[0][0] = S2[1][0] = S2[2][0] = 0.0;  
  18.     S2[0][1] = S2[1][1] = S2[2][1] = 0.0;  
  19.     S2[0][2] = S2[1][2] = S2[2][2] = 0.0;  
  20.   
  21.     // get center of mass  
  22.     for(i=0; i<vertCount; i++)  
  23.     {  
  24.         S1[0] += vertPos[i].x;  
  25.         S1[1] += vertPos[i].y;  
  26.         S1[2] += vertPos[i].z;  
  27.   
  28.         S2[0][0] += vertPos[i].x * vertPos[i].x;  
  29.         S2[1][1] += vertPos[i].y * vertPos[i].y;  
  30.         S2[2][2] += vertPos[i].z * vertPos[i].z;  
  31.         S2[0][1] += vertPos[i].x * vertPos[i].y;  
  32.         S2[0][2] += vertPos[i].x * vertPos[i].z;  
  33.         S2[1][2] += vertPos[i].y * vertPos[i].z;  
  34.     }  
  35.   
  36.     float n = (float)vertCount;  
  37.     // now get covariances  
  38.     Cov.m[0] = (float)(S2[0][0] - S1[0]*S1[0] / n) / n;  
  39.     Cov.m[5] = (float)(S2[1][1] - S1[1]*S1[1] / n) / n;  
  40.     Cov.m[10] = (float)(S2[2][2] - S1[2]*S1[2] / n) / n;  
  41.     Cov.m[4] = (float)(S2[0][1] - S1[0]*S1[1] / n) / n;  
  42.     Cov.m[9] = (float)(S2[1][2] - S1[1]*S1[2] / n) / n;  
  43.     Cov.m[8] = (float)(S2[0][2] - S1[0]*S1[2] / n) / n;  
  44.     Cov.m[1] = Cov.m[4];  
  45.     Cov.m[2] = Cov.m[8];  
  46.     Cov.m[6] = Cov.m[9];  
  47.   
  48.     return Cov;  
  49. }  
  50. //获取一个矢量在某个轴的分量  
  51. static float& _getElement( Vec3& point, int index)  
  52. {  
  53.     if (index == 0)  
  54.         return point.x;  
  55.     if (index == 1)  
  56.         return point.y;  
  57.     if (index == 2)  
  58.         return point.z;  
  59.   
  60.     CC_ASSERT(0);  
  61.     return point.x;  
  62. }  
  63. //获取特征向量  
  64. static void _getEigenVectors(Mat4* vout, Vec3* dout, Mat4 a)  
  65. {  
  66.     int n = 3;  
  67.     int j,iq,ip,i;  
  68.     double tresh, theta, tau, t, sm, s, h, g, c;  
  69.     int nrot;  
  70.     Vec3 b;  
  71.     Vec3 z;  
  72.     Mat4 v;  
  73.     Vec3 d;  
  74.   
  75.     v = Mat4::IDENTITY;  
  76.     for(ip = 0; ip < n; ip++)  
  77.     {  
  78.         _getElement(b, ip) = a.m[ip + 4 * ip];  
  79.         _getElement(d, ip) = a.m[ip + 4 * ip];  
  80.         _getElement(z, ip) = 0.0;  
  81.     }  
  82.   
  83.     nrot = 0;  
  84.   
  85.     for(i = 0; i < 50; i++)  
  86.     {  
  87.         sm = 0.0;  
  88.         for(ip = 0; ip < n; ip++) for(iq = ip+1; iq < n; iq++) sm += fabs(a.m[ip + 4 * iq]);  
  89.         if( fabs(sm) < FLT_EPSILON )  
  90.         {  
  91.             v.transpose();  
  92.             *vout = v;  
  93.             *dout = d;  
  94.             return;  
  95.         }  
  96.   
  97.         if (i < 3)  
  98.             tresh = 0.2 * sm / (n*n);  
  99.         else   
  100.             tresh = 0.0;  
  101.   
  102.         for(ip = 0; ip < n; ip++)  
  103.         {  
  104.             for(iq = ip + 1; iq < n; iq++)  
  105.             {  
  106.                 g = 100.0 * fabs(a.m[ip + iq * 4]);  
  107.                 float dmip = _getElement(d, ip);  
  108.                 float dmiq = _getElement(d, iq);  
  109.   
  110.                 if( i>3 && fabs(dmip) + g == fabs(dmip) && fabs(dmiq) + g == fabs(dmiq) )  
  111.                 {  
  112.                     a.m[ip + 4 * iq] = 0.0;  
  113.                 }  
  114.                 else if (fabs(a.m[ip + 4 * iq]) > tresh)  
  115.                 {  
  116.                     h = dmiq - dmip;  
  117.                     if (fabs(h) + g == fabs(h))  
  118.                     {  
  119.                         t=(a.m[ip + 4 * iq])/h;  
  120.                     }  
  121.                     else  
  122.                     {  
  123.                         theta = 0.5 * h / (a.m[ip + 4 * iq]);  
  124.                         t=1.0 / (fabs(theta) + sqrt(1.0 + theta * theta));  
  125.                         if (theta < 0.0) t = -t;  
  126.                     }  
  127.                     c = 1.0 / sqrt(1+t*t);  
  128.                     s = t*c;  
  129.                     tau = s / (1.0+c);  
  130.                     h = t * a.m[ip + 4 * iq];  
  131.                     _getElement(z, ip) -= (float)h;  
  132.                     _getElement(z, iq) += (float)h;  
  133.                     _getElement(d, ip) -= (float)h;  
  134.                     _getElement(d, iq) += (float)h;  
  135.                     a.m[ip + 4 * iq]=0.0;  
  136.                     for(j = 0; j < ip; j++) { ROTATE(a,j,ip,j,iq); }  
  137.                     for(j = ip + 1; j < iq; j++) { ROTATE(a,ip,j,j,iq); }  
  138.                     for(j = iq + 1; j < n; j++) { ROTATE(a,ip,j,iq,j); }  
  139.                     for(j = 0; j < n; j++) { ROTATE(v,j,ip,j,iq); }  
  140.                     nrot++;  
  141.                 }  
  142.             }  
  143.         }  
  144.   
  145.         for(ip = 0; ip < n; ip++)  
  146.         {  
  147.             _getElement(b, ip) += _getElement(z, ip);  
  148.             _getElement(d, ip) = _getElement(b, ip);  
  149.             _getElement(z, ip) = 0.0f;  
  150.         }  
  151.     }  
  152.   
  153.     v.transpose();  
  154.     *vout = v;  
  155.     *dout = d;  
  156.     return;  
  157. }  
  158. //创建OBB包围盒取向矩阵  
  159. static Mat4 _getOBBOrientation(const Vec3* vertPos, int num)  
  160. {  
  161.     Mat4 Cov; //创建一个 4*4 矩阵  
  162.   
  163.     if (num <= 0)  
  164.         return Mat4::IDENTITY; //返回单位矩阵  
  165.   
  166.     Cov = _getConvarianceMatrix(vertPos, num); //创建协方差矩阵  
  167.   
  168.     // now get eigenvectors  
  169.     Mat4 Evecs;  
  170.     Vec3 Evals;  
  171.     _getEigenVectors(&Evecs, &Evals, Cov); //求特征向量  
  172.   
  173.     Evecs.transpose(); //转置  
  174.   
  175.     return Evecs;  
  176. }  
  177. //默认构造函数  
  178. OBB::OBB()  
  179. {  
  180.     //数据复位  
  181.     reset();  
  182. }  
  183. //由一个AABB包围盒生成OBB包围盒  
  184. OBB::OBB(const AABB& aabb)  
  185. {  
  186.     //数据复位  
  187.     reset();  
  188.       
  189.     //中心点  
  190.     _center = (aabb._min + aabb._max);  
  191.     _center.scale(0.5f);  
  192.       
  193.     //各轴旋转矩阵的单位矩阵  
  194.     _xAxis = Vec3(1.0f, 0.0f, 0.0f);  
  195.     _yAxis = Vec3(0.0f, 1.0f, 0.0f);  
  196.     _zAxis = Vec3(0.0f, 0.0f, 1.0f);  
  197.       
  198.     //半尺存 半长 半宽 半高  
  199.     _extents = aabb._max - aabb._min;  
  200.     _extents.scale(0.5f);  
  201. }  
  202. //构造函数 根据点信息初始化一个OBB包围盒  
  203. OBB::OBB(const Vec3* verts, int num)  
  204. {  
  205.     if (!verts) return//如果verts不存在 返回  
  206.       
  207.     reset(); //数据复位  
  208.       
  209.     Mat4 matTransform = _getOBBOrientation(verts, num); //创建包围盒取向矩阵  
  210.       
  211.     /*   
  212.         matTransform是一个正交矩阵,所以它的逆矩阵就是它的转置; 
  213.         AA'=E(E为单位矩阵,A'表示“矩阵A的转置矩阵”) A称为正交矩阵 
  214.     */  
  215.     matTransform.transpose(); //计算matTransform矩阵的转置(此处相当于求逆矩)  
  216.       
  217.     Vec3 vecMax = matTransform * Vec3(verts[0].x, verts[0].y, verts[0].z);  
  218.       
  219.     Vec3 vecMin = vecMax;  
  220.       
  221.     for (int i = 1; i < num; i++)  
  222.     {  
  223.         Vec3 vect = matTransform * Vec3(verts[i].x, verts[i].y, verts[i].z);  
  224.           
  225.         vecMax.x = vecMax.x > vect.x ? vecMax.x : vect.x;  
  226.         vecMax.y = vecMax.y > vect.y ? vecMax.y : vect.y;  
  227.         vecMax.z = vecMax.z > vect.z ? vecMax.z : vect.z;  
  228.           
  229.         vecMin.x = vecMin.x < vect.x ? vecMin.x : vect.x;  
  230.         vecMin.y = vecMin.y < vect.y ? vecMin.y : vect.y;  
  231.         vecMin.z = vecMin.z < vect.z ? vecMin.z : vect.z;  
  232.     }  
  233.       
  234.     matTransform.transpose();  
  235.       
  236.     _xAxis = Vec3(matTransform.m[0], matTransform.m[1], matTransform.m[2]);  
  237.     _yAxis = Vec3(matTransform.m[4], matTransform.m[5], matTransform.m[6]);  
  238.     _zAxis = Vec3(matTransform.m[8], matTransform.m[9], matTransform.m[10]);  
  239.       
  240.     _center = 0.5f * (vecMax + vecMin);  
  241.     _center *= matTransform;  
  242.       
  243.     _xAxis.normalize();  
  244.     _yAxis.normalize();  
  245.     _zAxis.normalize();  
  246.       
  247.     _extents = 0.5f * (vecMax - vecMin);  
  248. }  
  249. //判断一点是否在OBB包围盒内  
  250. bool OBB::containPoint(const Vec3& point) const  
  251. {  
  252.     //相当于将点坐标从世界坐标系中转换到了OBB包围盒的物体坐标系中  
  253.     Vec3 vd = point - _center;  
  254.       
  255.     /* 
  256.       dot方法为求点积 
  257.       由于_xAxis为单位矢量 
  258.       vd与_xAxis的点击即为在_xAxis方向的投影 
  259.     */  
  260.     float d = vd.dot(_xAxis); //计算x方向投影d  
  261.       
  262.     //判断投影是否大于x正方向的半长或小于x负方向半长  
  263.     if (d > _extents.x || d < -_extents.x)  
  264.         return false;//满足条件说明不在包围盒内  
  265.   
  266.     d = vd.dot(_yAxis); //计算y方向投影  
  267.     //同理  
  268.     if (d > _extents.y || d < -_extents.y)  
  269.         return false;  
  270.   
  271.     d = vd.dot(_zAxis);//计算z方向投影  
  272.     if (d > _extents.z || d < -_extents.z)  
  273.         return false;  
  274.   
  275.     return true;  
  276. }  
  277. //指定OBB包围盒的变量值  
  278. void OBB::set(const Vec3& center, const Vec3& xAxis, const Vec3& yAxis, const Vec3& zAxis, const Vec3& extents)  
  279. {  
  280.     _center = center;  
  281.     _xAxis = xAxis;  
  282.     _yAxis = yAxis;  
  283.     _zAxis = zAxis;  
  284.     _extents = extents;  
  285. }  
  286. //复位  
  287. void OBB::reset()  
  288. {  
  289.     memset(this, 0, sizeof(OBB)); //将OBB所在内存块置零  
  290. }  
  291. //获取顶点信息  
  292. void OBB::getCorners(Vec3* verts) const  
  293. {  
  294.     Vec3 extX = _xAxis * _extents.x;  //x方向分量  
  295.     Vec3 extY = _yAxis * _extents.y;  //y方向分量  
  296.     Vec3 extZ = _zAxis * _extents.z;  //z方向分量  
  297.       
  298.     //z轴正方向的面  
  299.     verts[0] = _center - extX + extY + extZ;     // 左上顶点坐标  
  300.     verts[1] = _center - extX - extY + extZ;     // 左下顶点坐标  
  301.     verts[2] = _center + extX - extY + extZ;     // 右下顶点坐标  
  302.     verts[3] = _center + extX + extY + extZ;     // 右上顶点坐标  
  303.       
  304.     //z轴负方向的面  
  305.     verts[4] = _center + extX + extY - extZ;     // 右上顶点坐标  
  306.     verts[5] = _center + extX - extY - extZ;     // 右下顶点坐标  
  307.     verts[6] = _center - extX - extY - extZ;     // 左下顶点坐标  
  308.     verts[7] = _center - extX + extY - extZ;     // 左上顶点坐标  
  309. }  
  310. //将点投影到坐标轴  
  311. float OBB::projectPoint(const Vec3& point, const Vec3& axis)const  
  312. {  
  313.     float dot = axis.dot(point); //点积  
  314.     float ret = dot * point.length();  
  315.     return ret;  
  316. }  
  317. //计算最大最小投影值  
  318. void OBB::getInterval(const OBB& box, const Vec3& axis, float &min, float &max)const  
  319. {  
  320.     Vec3 corners[8];  
  321.     box.getCorners(corners);//获取包围盒顶点信息  
  322.     float value;  
  323.     //分别投影八个点,取最大和最小值  
  324.     min = max = projectPoint(axis, corners[0]);  
  325.     for(int i = 1; i < 8; i++)  
  326.     {  
  327.         value = projectPoint(axis, corners[i]);  
  328.         min = MIN(min, value);  
  329.         max = MAX(max, value);  
  330.     }  
  331. }  
  332. //取边的矢量  
  333. Vec3 OBB::getEdgeDirection(int index)const  
  334. {  
  335.     Vec3 corners[8];  
  336.     getCorners(corners); //获取八个顶点信息  
  337.       
  338.     Vec3 tmpLine;  
  339.     switch(index)  
  340.     {  
  341.         case 0:// x轴方向  
  342.             tmpLine = corners[5] - corners[6];  
  343.             tmpLine.normalize(); //归一化  
  344.             break;  
  345.         case 1:// y轴方向  
  346.             tmpLine = corners[7] - corners[6];  
  347.             tmpLine.normalize();  
  348.             break;  
  349.         case 2:// z轴方向  
  350.             tmpLine = corners[1] - corners[6];  
  351.             tmpLine.normalize();  
  352.             break;  
  353.         default:  
  354.             CCASSERT(0, "Invalid index!");  
  355.             break;  
  356.     }  
  357.     return tmpLine;  
  358. }  
  359. //取面的方向矢量  
  360. Vec3 OBB::getFaceDirection(int index) const  
  361. {  
  362.     Vec3 corners[8];  
  363.     getCorners(corners); //获取八个顶点信息  
  364.       
  365.     Vec3 faceDirection, v0, v1;  
  366.     switch(index)  
  367.     {  
  368.         case 0://前/后 计算结果为一个与z轴平行的矢量  
  369.             v0 = corners[2] - corners[1]; //朝向+z的面 左下点->右下点的矢量  
  370.             v1 = corners[0] - corners[1]; //          左下点->左上点的矢量  
  371.             /* 
  372.                两个矢量的叉积得到的结果 
  373.                是垂直于原来两个相乘矢量的矢量 
  374.              */  
  375.             Vec3::cross(v0, v1, &faceDirection); //计算v0,v1的叉积 结果存储到faceDirection  
  376.             /* 
  377.                 归一化 
  378.                 此处相当于求x,y轴所在平面的法矢量 
  379.              */  
  380.             faceDirection.normalize();  
  381.             break;  
  382.         case 1:// 左/右 计算结果为一个与x轴平行的矢量  
  383.             v0 = corners[5] - corners[2];  
  384.             v1 = corners[3] - corners[2];  
  385.             Vec3::cross(v0, v1, &faceDirection);  
  386.             faceDirection.normalize();  
  387.             break;  
  388.         case 2:// 上/下 计算结果为一个与y轴平行的矢量  
  389.             v0 = corners[1] - corners[2];  
  390.             v1 = corners[5] - corners[2];  
  391.             Vec3::cross(v0, v1, &faceDirection);  
  392.             faceDirection.normalize();  
  393.             break;  
  394.         default:  
  395.             CCASSERT(0, "Invalid index!");  
  396.             break;  
  397.     }  
  398.     return faceDirection; //返回方向矢量  
  399. }  
  400. //检测两个OBB包围盒是否重合  
  401. bool OBB::intersects(const OBB& box) const  
  402. {  
  403.     float min1, max1, min2, max2;  
  404.     //当前包围盒的三个面方向 相当于取包围盒的三个坐标轴为分离轴并计算投影作比较  
  405.     for (int i = 0; i < 3; i++)  
  406.     {  
  407.         getInterval(*this, getFaceDirection(i), min1, max1);//计算当前包围盒在某轴上的最大最小投影值  
  408.         getInterval(box, getFaceDirection(i), min2, max2);//计算另一个包围盒在某轴上的最大最小投影值  
  409.         if (max1 < min2 || max2 < min1) return false//判断分离轴上投影是否重合  
  410.     }  
  411.     //box包围盒的三个面方向  
  412.     for (int i = 0; i < 3; i++)  
  413.     {  
  414.         getInterval(*this, box.getFaceDirection(i), min1, max1);  
  415.         getInterval(box, box.getFaceDirection(i), min2, max2);  
  416.         if (max1 < min2 || max2 < min1) return false;  
  417.     }  
  418.       
  419.     for (int i = 0; i < 3; i++)  
  420.     {  
  421.         for (int j = 0; j < 3; j++)  
  422.         {  
  423.             Vec3 axis;  
  424.             //Vec3::cross(getFaceDirection(i), box.getFaceDirection(j), &axis); //2d-x源代码  
  425.             Vec3::cross(getEdgeDirection(i), box.getEdgeDirection(j), &axis); //修改,这里应该边的矢量并做叉积  
  426.             getInterval(*this, axis, min1, max1);  
  427.             getInterval(box, axis, min2, max2);  
  428.             if (max1 < min2 || max2 < min1) return false;  
  429.         }  
  430.     }  
  431.       
  432.     return true;  
  433. }  
  434.   
  435. //由一个给定矩阵对OBB包围盒进行变换  
  436. void OBB::transform(const Mat4& mat)  
  437. {  
  438.     // 新的中心点  
  439.     Vec4 newcenter = mat * Vec4(_center.x, _center.y, _center.z, 1.0f);  
  440.     _center.x = newcenter.x;  
  441.     _center.y = newcenter.y;  
  442.     _center.z = newcenter.z;  
  443.   
  444.     //变换向量  
  445.     _xAxis = mat * _xAxis;  
  446.     _yAxis = mat * _yAxis;  
  447.     _zAxis = mat * _zAxis;  
  448.   
  449.     _xAxis.normalize();  //归一化  
  450.     _yAxis.normalize();  
  451.     _zAxis.normalize();  
  452.   
  453.     Vec3 scale, trans;   
  454.     Quaternion quat;  //四元数 单位长度的四元数可以表示三维旋转  
  455.     mat.decompose(&scale, &quat, &trans);  
  456.   
  457.     //半长 半宽 半高   
  458.     _extents.x *= scale.x;  
  459.     _extents.y *= scale.y;  
  460.     _extents.z *= scale.z;  
  461. }  
  462.   
  463. NS_CC_END  

如社区发表内容存在侵权行为,您可以点击这里查看侵权投诉指引