开通博客赚积分
发布资源赚积分
分类

源码开发语言/平台
当前位置：首页 > 源码/资料 > 游戏 > 射击游戏 > 查看源码
Frustum.cpp
资源名称：QuakeBsp.rar　[点击查看]
上传用户：cxh8989
上传日期：2021-01-22
资源大小：2544k
文件大小：9k
源码类别：

射击游戏

开发平台：

Visual C++

Frustum.cpp：源码内容
  2. #include "Frustum.h"
  4. #define FIRST_OBJECT_ID  3
  6. enum FrustumSide
  7. {
  8. RIGHT = 0, // 右平面
  9. LEFT = 1, // 左平面
  10. BOTTOM = 2, // 底平面
  11. TOP = 3, // 顶平面
  12. BACK = 4, // 后平面
  13. FRONT = 5 // 前平面
  14. }; 
  16. enum PlaneData
  17. {
  18. A = 0, //（A，B，C）分别为平面法向量
  19. B = 1,
  20. C = 2,
  21. D = 3
  22. };
  24. void NormalizePlane(float frustum[6][4], int side)
  25. {
  26. float magnitude = (float)sqrt( frustum[side][A] * frustum[side][A] + 
  27.    frustum[side][B] * frustum[side][B] + 
  28.    frustum[side][C] * frustum[side][C] );
  30. frustum[side][A] /= magnitude;
  31. frustum[side][B] /= magnitude;
  32. frustum[side][C] /= magnitude;
  33. frustum[side][D] /= magnitude; 
  34. }
  36. /** 从模型矩阵和投影矩阵计算平头体 */
  37. void CFrustum::CalculateFrustum()
  38. {    
  39. float   proj[16];
  40. float   modl[16];
  41. float   clip[16];
  43. /** 获得当前模型矩阵和投影矩阵 */
  44. glGetFloatv( GL_PROJECTION_MATRIX, proj );
  46. glGetFloatv( GL_MODELVIEW_MATRIX, modl );
  49. clip[ 0] = modl[ 0] * proj[ 0] + modl[ 1] * proj[ 4] + modl[ 2] * proj[ 8] + modl[ 3] * proj[12];
  50. clip[ 1] = modl[ 0] * proj[ 1] + modl[ 1] * proj[ 5] + modl[ 2] * proj[ 9] + modl[ 3] * proj[13];
  51. clip[ 2] = modl[ 0] * proj[ 2] + modl[ 1] * proj[ 6] + modl[ 2] * proj[10] + modl[ 3] * proj[14];
  52. clip[ 3] = modl[ 0] * proj[ 3] + modl[ 1] * proj[ 7] + modl[ 2] * proj[11] + modl[ 3] * proj[15];
  54. clip[ 4] = modl[ 4] * proj[ 0] + modl[ 5] * proj[ 4] + modl[ 6] * proj[ 8] + modl[ 7] * proj[12];
  55. clip[ 5] = modl[ 4] * proj[ 1] + modl[ 5] * proj[ 5] + modl[ 6] * proj[ 9] + modl[ 7] * proj[13];
  56. clip[ 6] = modl[ 4] * proj[ 2] + modl[ 5] * proj[ 6] + modl[ 6] * proj[10] + modl[ 7] * proj[14];
  57. clip[ 7] = modl[ 4] * proj[ 3] + modl[ 5] * proj[ 7] + modl[ 6] * proj[11] + modl[ 7] * proj[15];
  59. clip[ 8] = modl[ 8] * proj[ 0] + modl[ 9] * proj[ 4] + modl[10] * proj[ 8] + modl[11] * proj[12];
  60. clip[ 9] = modl[ 8] * proj[ 1] + modl[ 9] * proj[ 5] + modl[10] * proj[ 9] + modl[11] * proj[13];
  61. clip[10] = modl[ 8] * proj[ 2] + modl[ 9] * proj[ 6] + modl[10] * proj[10] + modl[11] * proj[14];
  62. clip[11] = modl[ 8] * proj[ 3] + modl[ 9] * proj[ 7] + modl[10] * proj[11] + modl[11] * proj[15];
  64. clip[12] = modl[12] * proj[ 0] + modl[13] * proj[ 4] + modl[14] * proj[ 8] + modl[15] * proj[12];
  65. clip[13] = modl[12] * proj[ 1] + modl[13] * proj[ 5] + modl[14] * proj[ 9] + modl[15] * proj[13];
  66. clip[14] = modl[12] * proj[ 2] + modl[13] * proj[ 6] + modl[14] * proj[10] + modl[15] * proj[14];
  67. clip[15] = modl[12] * proj[ 3] + modl[13] * proj[ 7] + modl[14] * proj[11] + modl[15] * proj[15];
  70. m_Frustum[RIGHT][A] = clip[ 3] - clip[ 0];
  71. m_Frustum[RIGHT][B] = clip[ 7] - clip[ 4];
  72. m_Frustum[RIGHT][C] = clip[11] - clip[ 8];
  73. m_Frustum[RIGHT][D] = clip[15] - clip[12];
  75. NormalizePlane(m_Frustum, RIGHT);
  77. /** 左平面 */
  78. m_Frustum[LEFT][A] = clip[ 3] + clip[ 0];
  79. m_Frustum[LEFT][B] = clip[ 7] + clip[ 4];
  80. m_Frustum[LEFT][C] = clip[11] + clip[ 8];
  81. m_Frustum[LEFT][D] = clip[15] + clip[12];
  84. NormalizePlane(m_Frustum, LEFT);
  86. /** 底平面 */
  87. m_Frustum[BOTTOM][A] = clip[ 3] + clip[ 1];
  88. m_Frustum[BOTTOM][B] = clip[ 7] + clip[ 5];
  89. m_Frustum[BOTTOM][C] = clip[11] + clip[ 9];
  90. m_Frustum[BOTTOM][D] = clip[15] + clip[13];
  92. NormalizePlane(m_Frustum, BOTTOM);
  94. /** 顶平面 */
  95. m_Frustum[TOP][A] = clip[ 3] - clip[ 1];
  96. m_Frustum[TOP][B] = clip[ 7] - clip[ 5];
  97. m_Frustum[TOP][C] = clip[11] - clip[ 9];
  98. m_Frustum[TOP][D] = clip[15] - clip[13];
  100. NormalizePlane(m_Frustum, TOP);
  102.    /** 后平面 */
  103. m_Frustum[BACK][A] = clip[ 3] - clip[ 2];
  104. m_Frustum[BACK][B] = clip[ 7] - clip[ 6];
  105. m_Frustum[BACK][C] = clip[11] - clip[10];
  106. m_Frustum[BACK][D] = clip[15] - clip[14];
  108. NormalizePlane(m_Frustum, BACK);
  110. /** 前平面 */
  111. m_Frustum[FRONT][A] = clip[ 3] + clip[ 2];
  112. m_Frustum[FRONT][B] = clip[ 7] + clip[ 6];
  113. m_Frustum[FRONT][C] = clip[11] + clip[10];
  114. m_Frustum[FRONT][D] = clip[15] + clip[14];
  116. NormalizePlane(m_Frustum, FRONT);
  117. }
  119. bool CFrustum::PointInFrustum( float x, float y, float z )
  120. {
  122. for(int i = 0; i < 6; i++ )
  123. {
  124. if(m_Frustum[i][A] * x + m_Frustum[i][B] * y + m_Frustum[i][C] * z + m_Frustum[i][D] <= 0)
  125. {
  126. return false;
  127. }
  128. }
  130. return true;
  131. }
  135. bool CFrustum::SphereInFrustum( float x, float y, float z, float radius )
  136. {
  137. for(int i = 0; i < 6; i++ )
  138. {
  139. if( m_Frustum[i][A] * x + m_Frustum[i][B] * y + m_Frustum[i][C] * z + m_Frustum[i][D] <= -radius )
  140. {
  141. return false;
  142. }
  143. }
  145. return true;
  146. }
  149. bool CFrustum::CubeInFrustum( float x, float y, float z, float size )
  150. {
  152. for(int i = 0; i < 6; i++ )
  153. {
  154. if(m_Frustum[i][A] * (x - size) + m_Frustum[i][B] * (y - size) + m_Frustum[i][C] * (z - size) + m_Frustum[i][D] > 0)
  155.    continue;
  156. if(m_Frustum[i][A] * (x + size) + m_Frustum[i][B] * (y - size) + m_Frustum[i][C] * (z - size) + m_Frustum[i][D] > 0)
  157.    continue;
  158. if(m_Frustum[i][A] * (x - size) + m_Frustum[i][B] * (y + size) + m_Frustum[i][C] * (z - size) + m_Frustum[i][D] > 0)
  159.    continue;
  160. if(m_Frustum[i][A] * (x + size) + m_Frustum[i][B] * (y + size) + m_Frustum[i][C] * (z - size) + m_Frustum[i][D] > 0)
  161.    continue;
  162. if(m_Frustum[i][A] * (x - size) + m_Frustum[i][B] * (y - size) + m_Frustum[i][C] * (z + size) + m_Frustum[i][D] > 0)
  163.    continue;
  164. if(m_Frustum[i][A] * (x + size) + m_Frustum[i][B] * (y - size) + m_Frustum[i][C] * (z + size) + m_Frustum[i][D] > 0)
  165.    continue;
  166. if(m_Frustum[i][A] * (x - size) + m_Frustum[i][B] * (y + size) + m_Frustum[i][C] * (z + size) + m_Frustum[i][D] > 0)
  167.    continue;
  168. if(m_Frustum[i][A] * (x + size) + m_Frustum[i][B] * (y + size) + m_Frustum[i][C] * (z + size) + m_Frustum[i][D] > 0)
  169.    continue;
  171. return false;
  172. }
  174. return true;
  175. }
  178. bool CFrustum::BoxInFrustum( float x, float y, float z, float x2, float y2, float z2)
  179. {
  180. for(int i = 0; i < 6; i++ )
  181. {
  182. if(m_Frustum[i][A] * x  + m_Frustum[i][B] * y  + m_Frustum[i][C] * z  + m_Frustum[i][D] > 0)  continue;
  183. if(m_Frustum[i][A] * x2 + m_Frustum[i][B] * y  + m_Frustum[i][C] * z  + m_Frustum[i][D] > 0)  continue;
  184. if(m_Frustum[i][A] * x  + m_Frustum[i][B] * y2 + m_Frustum[i][C] * z  + m_Frustum[i][D] > 0)  continue;
  185. if(m_Frustum[i][A] * x2 + m_Frustum[i][B] * y2 + m_Frustum[i][C] * z  + m_Frustum[i][D] > 0)  continue;
  186. if(m_Frustum[i][A] * x  + m_Frustum[i][B] * y  + m_Frustum[i][C] * z2 + m_Frustum[i][D] > 0)  continue;
  187. if(m_Frustum[i][A] * x2 + m_Frustum[i][B] * y  + m_Frustum[i][C] * z2 + m_Frustum[i][D] > 0)  continue;
  188. if(m_Frustum[i][A] * x  + m_Frustum[i][B] * y2 + m_Frustum[i][C] * z2 + m_Frustum[i][D] > 0)  continue;
  189. if(m_Frustum[i][A] * x2 + m_Frustum[i][B] * y2 + m_Frustum[i][C] * z2 + m_Frustum[i][D] > 0)  continue;
  191. return false;
  192. }
  194. return true;
  195. }
  198. void CDebug::RenderDebugLines()
  199. {
  200.     glDisable(GL_TEXTURE_2D);
  202. glBegin(GL_LINES);
  204. glColor3ub(255, 255, 0);
  206. for(unsigned int i = 0; i < m_vLines.size(); i++)
  207. {
  208. glVertex3f(m_vLines[i].x, m_vLines[i].y, m_vLines[i].z);
  209. }
  211. glEnd();
  212. }
  215. void CDebug::AddDebugLine(CVector3 vPoint1, CVector3 vPoint2)
  216. {
  217. m_vLines.push_back(vPoint1);
  218. m_vLines.push_back(vPoint2);
  219. }
  222. void CDebug::AddDebugBox(CVector3 vCenter, float width, float height, float depth)
  223. {
  224. width /= 2.0f; height /= 2.0f; depth /= 2.0f;
  226. CVector3 vTopLeftFront( vCenter.x - width, vCenter.y + height, vCenter.z + depth);
  227. CVector3 vTopLeftBack(  vCenter.x - width, vCenter.y + height, vCenter.z - depth);
  228. CVector3 vTopRightBack( vCenter.x + width, vCenter.y + height, vCenter.z - depth);
  229. CVector3 vTopRightFront(vCenter.x + width, vCenter.y + height, vCenter.z + depth);
  231. CVector3 vBottom_LeftFront( vCenter.x - width, vCenter.y - height, vCenter.z + depth);
  232. CVector3 vBottom_LeftBack(  vCenter.x - width, vCenter.y - height, vCenter.z - depth);
  233. CVector3 vBottomRightBack( vCenter.x + width, vCenter.y - height, vCenter.z - depth);
  234. CVector3 vBottomRightFront(vCenter.x + width, vCenter.y - height, vCenter.z + depth);
  236. m_vLines.push_back(vTopLeftFront); m_vLines.push_back(vTopRightFront);
  238. m_vLines.push_back(vTopLeftBack);   m_vLines.push_back(vTopRightBack);
  240. m_vLines.push_back(vTopLeftFront); m_vLines.push_back(vTopLeftBack);
  242. m_vLines.push_back(vTopRightFront); m_vLines.push_back(vTopRightBack);
  244. m_vLines.push_back(vBottom_LeftFront); m_vLines.push_back(vBottomRightFront);
  246. m_vLines.push_back(vBottom_LeftBack); m_vLines.push_back(vBottomRightBack);
  249. m_vLines.push_back(vBottom_LeftFront); m_vLines.push_back(vBottom_LeftBack);
  252. m_vLines.push_back(vBottomRightFront); m_vLines.push_back(vBottomRightBack);
  254. m_vLines.push_back(vTopLeftFront); m_vLines.push_back(vBottom_LeftFront);
  257. m_vLines.push_back(vTopLeftBack); m_vLines.push_back(vBottom_LeftBack);
  260. m_vLines.push_back(vTopRightBack); m_vLines.push_back(vBottomRightBack);
  262. m_vLines.push_back(vTopRightFront); m_vLines.push_back(vBottomRightFront);
  263. }