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

源码开发语言/平台
当前位置：首页 > 源码/资料 > 游戏 > 其他游戏 > 查看源码
afMatrix.cpp
资源名称：AirForce.rar　[点击查看]
上传用户：kaiguan
上传日期：2007-10-28
资源大小：1074k
文件大小：8k
源码类别：

其他游戏

开发平台：

Visual C++

afMatrix.cpp：源码内容
  1. #include "afMatrix.h"
  3. #include "afVec3.h"
  4. #include "afVec3n.h"
  5. #include "afVec4.h"
  7. #include <D3DX8.h>
  8. #include <assert.h>
  9. #include <math.h>
  12. void sincos(float a, float& s, float& c)
  13. {
  14. s = (float)sin(a);
  15. c = (float)cos(a);
  16. }
  19. afMatrix::afMatrix()
  20. {
  21. makeIdent();
  22. }
  25. afMatrix::afMatrix(const float* nElements)
  26. {
  27. memcpy(&m00, nElements, 16*sizeof(float));
  28. }
  31. afMatrix::afMatrix(const D3DXMATRIX& nMat)
  32. {
  33. *getD3DMatrix() = nMat;
  34. }
  37. void
  38. afMatrix::makeIdent()
  39. {
  40.     m00 = m11 = m22 = m33 = 1.0f;
  41.     m01 = m02 = m03 =
  42.     m10 = m12 = m13 =
  43.     m20 = m21 = m23 =
  44.     m30 = m31 = m32 = 0.0f;
  45. }
  48. void
  49. afMatrix::makeProjection(float nFovY, float nAspect, float nNear, float nFar)
  50. {
  51. float h = (float)(cos(nFovY/2) / sin(nFovY/2));
  52. float w = h / nAspect;
  54. m00 = w; //2*nNear/w;
  55. m01 = m02 = m03 = m10 = 0.0f;
  57. m11 = h; //2*nNear/h;
  58. m12 = m13 = m20 = m21 = 0.0f;
  59. m22 = nFar/(nFar-nNear);
  60. m23 = 1.0f;
  61. m30 = m31 = 0.0f;
  62. m32 = nNear*nFar/(nNear-nFar);
  63. m33 = 0.0f;
  64. }
  67. void
  68. afMatrix::makeRotZXY(float nHead, float nPitch, float nRoll)
  69. {
  70.     float sinY;
  71.     float cosY;
  72.     sincos(nHead, sinY, cosY);
  73.     float sinX;
  74.     float cosX;
  75.     sincos(nPitch, sinX, cosX);
  76.     float sinZ;
  77.     float cosZ;
  78.     sincos(nRoll, sinZ, cosZ);
  80.     float cosYxcosZ = cosY*cosZ;
  81.     float sinYxsinZ = sinY*sinZ;
  82.     float sinYxcosZ = sinY*cosZ;
  83.     float cosYxsinZ = cosY*sinZ;
  84.     m00 = sinX*sinYxsinZ + cosYxcosZ;
  85.     m01 = - cosX*sinZ;
  86.     m02 = sinX*cosYxsinZ - sinYxcosZ;
  87.     m10 = cosYxsinZ - sinX*sinYxcosZ;
  88.     m11 = cosX*cosZ;
  89.     m12 = - sinX*cosYxcosZ - sinYxsinZ;
  90.     m20 = cosX*sinY;
  91.     m21 = sinX;
  92.     m22 = cosX*cosY;
  93.     m03 = m13 = m23 = m30 = m31 = m32 = 0.0f;
  94.     m33 = 1.0f;
  95. }
  98. void 
  99. afMatrix::makeTrans(const afVec3& nTrans)
  100. {
  101.     m00 = m11 = m22 = m33 = 1.0f;
  102.     m01 = m02 = m03 =
  103.     m10 = m12 = m13 =
  104.     m20 = m21 = m23 = 0.0f;
  105.     m30 = nTrans[0];
  106.     m31 = nTrans[1];
  107.     m32 = nTrans[2];
  108. }
  111. bool
  112. afMatrix::makeLookat(const afVec3n& nDir, const afVec3n& nUp)
  113. {
  114.     afVec3 vec1, vec2;
  115.     vec1.cross( nUp, nDir );
  116.     vec2.cross( nDir, vec1 );
  117.     if (vec1.normalize()==0.0f || vec2.normalize()==0.0f)
  118.         return false;
  120.     m00 = vec1[0];
  121.     m01 = vec1[1];
  122.     m02 = vec1[2];
  124.     m10 = vec2[0];
  125.     m11 = vec2[1];
  126.     m12 = vec2[2];
  128.     m20 = nDir[0];
  129.     m21 = nDir[1];
  130.     m22 = nDir[2];
  132.     m03 = m13 = m23 = m30 = m31 = m32 = 0.0f;
  133.     m33 = 1.0f;
  134. return true;
  135. }
  138. void
  139. afMatrix::makeScale(const afVec3& scale)
  140. {
  141.     m00 = scale[0];
  142. m11 = scale[1];
  143. m22 = scale[2];
  144.     m01 = m02 = m03 =
  145.     m10 = m12 = m13 =
  146.     m20 = m21 = m23 =
  147.     m30 = m31 = m32 = 0.0f;
  148.     m33 = 1.0f;
  149. }
  152. void 
  153. afMatrix::makeScale(float s)
  154. {
  155.     m00 = m11 = m22 = s;
  156.     m01 = m02 = m03 =
  157.     m10 = m12 = m13 =
  158.     m20 = m21 = m23 =
  159.     m30 = m31 = m32 = 0.0f;
  160.     m33 = 1.0f;
  161. }
  164. bool 
  165. afMatrix::invert()
  166. {
  167.     afMatrix tmp(*this);
  169.     // Gauss-Jordan elimination with partial pivoting
  170.     makeIdent();
  171.     int i, j, i1;
  173.     // Loop over cols of a from left to right, eliminating above and below diag
  174.     for (j = 0; j<4; j++)
  175.     {
  176.         // Find largest pivot in column j among rows j..3
  177.         i1 = j;       // Row with largest pivot candidate
  178.         for (i = j+1; i<4; i++)
  179.             if (fabs(tmp[i][j])>fabs(tmp[i1][j]))
  180.                 i1 = i;
  182.         // Swap rows i1 and j in tmp and this to put pivot on diagonal
  183.         afVec4 swap(tmp[i1]);
  184.         tmp.rowVec4(i1) = tmp.rowVec4(j);
  185.         tmp.rowVec4(j) = swap;
  186.         swap = rowVec4(i1);
  187.         rowVec4(i1) = rowVec4(j);
  188.         rowVec4(j) = swap;
  190.         // Scale row j to have a unit diagonal
  191.         if (tmp[j][j]==0.f)
  192.             return false;
  194.         rowVec4(j) /= tmp[j][j];
  195.         tmp.rowVec4(j) /= tmp[j][j];
  197.         // Eliminate off-diagonal elems in col j of tmp, doing identical ops to this
  198.         for (i = 0; i<4; i++)
  199.             if (i!=j) 
  200.             {
  201.                 rowVec4(i) -= tmp[i][j]*rowVec4(j);
  202.                 tmp.rowVec4(i) -= tmp[i][j]*tmp.rowVec4(j);
  203.             }
  204.     }
  206.     return true;
  207. }
  210. void 
  211. afMatrix::preMult(const afMatrix& nLf)
  212. {
  213.     assert(this!=&nLf);
  215.     float r0,r1,r2;
  217.     r0 = m00; r1 = m10; r2 = m20;
  218.     m00 = nLf.m00*r0+nLf.m01*r1+nLf.m02*r2+nLf.m03*m30;
  219.     m10 = nLf.m10*r0+nLf.m11*r1+nLf.m12*r2+nLf.m13*m30;
  220.     m20 = nLf.m20*r0+nLf.m21*r1+nLf.m22*r2+nLf.m23*m30;
  221.     m30 = nLf.m30*r0+nLf.m31*r1+nLf.m32*r2+nLf.m33*m30;
  223.     r0 = m01; r1 = m11; r2 = m21;
  224.     m01 = nLf.m00*r0+nLf.m01*r1+nLf.m02*r2+nLf.m03*m31;
  225.     m11 = nLf.m10*r0+nLf.m11*r1+nLf.m12*r2+nLf.m13*m31;
  226.     m21 = nLf.m20*r0+nLf.m21*r1+nLf.m22*r2+nLf.m23*m31;
  227.     m31 = nLf.m30*r0+nLf.m31*r1+nLf.m32*r2+nLf.m33*m31;
  229.     r0 = m02; r1 = m12; r2 = m22;
  230.     m02 = nLf.m00*r0+nLf.m01*r1+nLf.m02*r2+nLf.m03*m32;
  231.     m12 = nLf.m10*r0+nLf.m11*r1+nLf.m12*r2+nLf.m13*m32;
  232.     m22 = nLf.m20*r0+nLf.m21*r1+nLf.m22*r2+nLf.m23*m32;
  233.     m32 = nLf.m30*r0+nLf.m31*r1+nLf.m32*r2+nLf.m33*m32;
  235.     r0 = m03; r1 = m13; r2 = m23;
  236.     m03 = nLf.m00*r0+nLf.m01*r1+nLf.m02*r2+nLf.m03*m33;
  237.     m13 = nLf.m10*r0+nLf.m11*r1+nLf.m12*r2+nLf.m13*m33;
  238.     m23 = nLf.m20*r0+nLf.m21*r1+nLf.m22*r2+nLf.m23*m33;
  239.     m33 = nLf.m30*r0+nLf.m31*r1+nLf.m32*r2+nLf.m33*m33;
  240. }
  243. void 
  244. afMatrix::postMult(const afMatrix& nRt)
  245. {
  246.     assert(this!=&nRt);
  248.     float l0, l1, l2;
  250.     l0 = m00; l1 = m01; l2 = m02;
  251.     m00 = l0*nRt.m00 + l1*nRt.m10 + l2*nRt.m20 + m03*nRt.m30;
  252.     m01 = l0*nRt.m01 + l1*nRt.m11 + l2*nRt.m21 + m03*nRt.m31;
  253.     m02 = l0*nRt.m02 + l1*nRt.m12 + l2*nRt.m22 + m03*nRt.m32;
  254.     m03 = l0*nRt.m03 + l1*nRt.m13 + l2*nRt.m23 + m03*nRt.m33;
  256.     l0 = m10; l1 = m11; l2 = m12;
  257.     m10 = l0*nRt.m00 + l1*nRt.m10 + l2*nRt.m20 + m13*nRt.m30;
  258.     m11 = l0*nRt.m01 + l1*nRt.m11 + l2*nRt.m21 + m13*nRt.m31;
  259.     m12 = l0*nRt.m02 + l1*nRt.m12 + l2*nRt.m22 + m13*nRt.m32;
  260.     m13 = l0*nRt.m03 + l1*nRt.m13 + l2*nRt.m23 + m13*nRt.m33;
  262.     l0 = m20; l1 = m21; l2 = m22;
  263.     m20 = l0*nRt.m00 + l1*nRt.m10 + l2*nRt.m20 + m23*nRt.m30;
  264.     m21 = l0*nRt.m01 + l1*nRt.m11 + l2*nRt.m21 + m23*nRt.m31;
  265.     m22 = l0*nRt.m02 + l1*nRt.m12 + l2*nRt.m22 + m23*nRt.m32;
  266.     m23 = l0*nRt.m03 + l1*nRt.m13 + l2*nRt.m23 + m23*nRt.m33;
  268.     l0 = m30; l1 = m31; l2 = m32;
  269.     m30 = l0*nRt.m00 + l1*nRt.m10 + l2*nRt.m20 + m33*nRt.m30;
  270.     m31 = l0*nRt.m01 + l1*nRt.m11 + l2*nRt.m21 + m33*nRt.m31;
  271.     m32 = l0*nRt.m02 + l1*nRt.m12 + l2*nRt.m22 + m33*nRt.m32;
  272.     m33 = l0*nRt.m03 + l1*nRt.m13 + l2*nRt.m23 + m33*nRt.m33;
  273. }
  276. void 
  277. afMatrix::multVector(afVec4& dst, const afVec4& src) const 
  278. {
  279.     dst[0] = src[0]*m00 + src[1]*m10 + src[2]*m20 + src[3]*m30;
  280.     dst[1] = src[0]*m01 + src[1]*m11 + src[2]*m21 + src[3]*m31;
  281.     dst[2] = src[0]*m02 + src[1]*m12 + src[2]*m22 + src[3]*m32;
  282.     dst[3] = src[0]*m03 + src[1]*m13 + src[2]*m23 + src[3]*m33;
  283. }
  286. void 
  287. afMatrix::multVector(afVec4& dst, const afVec3& src) const 
  288. {
  289.     dst[0] = src[0]*m00 + src[1]*m10 + src[2]*m20 + m30;
  290.     dst[1] = src[0]*m01 + src[1]*m11 + src[2]*m21 + m31;
  291.     dst[2] = src[0]*m02 + src[1]*m12 + src[2]*m22 + m32;
  292.     dst[3] = src[0]*m03 + src[1]*m13 + src[2]*m23 + m33;
  293. }
  296. void 
  297. afMatrix::multVector(afVec3& dst, const afVec3& src) const
  298. {
  299.     dst[0] = src[0]*m00 + src[1]*m10 + src[2]*m20 + m30;
  300.     dst[1] = src[0]*m01 + src[1]*m11 + src[2]*m21 + m31;
  301.     dst[2] = src[0]*m02 + src[1]*m12 + src[2]*m22 + m32;
  302. }
  305. afMatrix&
  306. afMatrix::operator=(const D3DXMATRIX& nMat)
  307. {
  308. *getD3DMatrix() = nMat;
  309. return *this;
  310. }
  313. bool
  314. afMatrix::operator==(const afMatrix& nMat) const
  315. {
  316. return  m00==nMat.m00 && m01==nMat.m01 && m02==nMat.m02 && m03==nMat.m03 &&
  317. m10==nMat.m10 && m11==nMat.m11 && m12==nMat.m12 && m13==nMat.m13 &&
  318. m20==nMat.m20 && m21==nMat.m21 && m22==nMat.m22 && m23==nMat.m23 &&
  319. m30==nMat.m30 && m31==nMat.m31 && m32==nMat.m32 && m33==nMat.m33;
  320. }