svd.cpp
上传用户:sun1608
上传日期:2007-02-02
资源大小:6116k
文件大小:5k
源码类别:

流媒体/Mpeg4/MP4

开发平台:

Visual C++

  1. /*************************************************************************
  2. This software module was originally developed by 
  3. Ming-Chieh Lee (mingcl@microsoft.com), Microsoft Corporation
  4. Wei-ge Chen (wchen@microsoft.com), Microsoft Corporation
  5. Bruce Lin (blin@microsoft.com), Microsoft Corporation
  6. Chuang Gu (chuanggu@microsoft.com), Microsoft Corporation
  7. (date: March, 1996)
  8. in the course of development of the MPEG-4 Video (ISO/IEC 14496-2). 
  9. This software module is an implementation of a part of one or more MPEG-4 Video tools 
  10. as specified by the MPEG-4 Video. 
  11. ISO/IEC gives users of the MPEG-4 Video free license to this software module or modifications 
  12. thereof for use in hardware or software products claiming conformance to the MPEG-4 Video. 
  13. Those intending to use this software module in hardware or software products are advised that its use may infringe existing patents. 
  14. The original developer of this software module and his/her company, 
  15. the subsequent editors and their companies, 
  16. and ISO/IEC have no liability for use of this software module or modifications thereof in an implementation. 
  17. Copyright is not released for non MPEG-4 Video conforming products. 
  18. Microsoft retains full right to use the code for his/her own purpose, 
  19. assign or donate the code to a third party and to inhibit third parties from using the code for non <MPEG standard> conforming products. 
  20. This copyright notice must be included in all copies or derivative works. 
  21. Copyright (c) 1996, 1997.
  22. Module Name:
  23. svd.cpp
  24. Abstract:
  25. Solution of Linear Algebraic Equations 
  26. Revision History:
  27. *************************************************************************/
  28. #include <stdlib.h>
  29. #include <math.h>
  30. #include "basic.hpp"
  31. #ifdef __MFC_
  32. #ifdef _DEBUG
  33. #undef THIS_FILE
  34. static char BASED_CODE THIS_FILE[] = __FILE__;
  35. #endif
  36. #define new DEBUG_NEW    
  37. #endif // __MFC_
  38. #define irowNull (-1)
  39. __inline static void SwapRow(Double *rgcoeff, Double *rgrhs, Int crow,
  40. Int irow1, Int irow2);
  41. __inline static void EliminateColumn(Double *rgcoeff, Double *rgrhs, Int crow,
  42. Int irowPiv);
  43. __inline static void BackSub(Double *rgcoeff, Double *rgrhs, Int crow);
  44. __inline static Int RowPivot(Double *rgcoeff, Int crow, Int irowBeg);
  45. Int FSolveLinEq(Double *rgcoeff, Double *rgrhs, Int crow)
  46. {
  47. Int irow;
  48. for (irow = 0; irow < crow; irow++)
  49. {
  50. Int irowPivot = RowPivot(rgcoeff, crow, irow);
  51. if (irowPivot == irowNull)
  52. return FALSE;
  53. SwapRow(rgcoeff, rgrhs, crow, irow, irowPivot);
  54. EliminateColumn(rgcoeff, rgrhs, crow, irow);
  55. }
  56. BackSub(rgcoeff, rgrhs, crow);
  57. return TRUE;
  58. }
  59. // Assumes that columns till column irow1 have been eliminated from the 
  60. // rows irow1 & irow2
  61. __inline static void SwapRow(Double *rgcoeff, Double *rgrhs, Int crow,
  62. Int irow1, Int irow2)
  63. {
  64. Int icol;
  65. Double coeffT, rhsT;
  66. Double *pcoeffRow1 = &rgcoeff[crow * irow1];
  67. Double *pcoeffRow2 = &rgcoeff[crow * irow2];
  68. for (icol = irow1; icol < crow; icol++)
  69. {
  70. coeffT = pcoeffRow1[icol];
  71. pcoeffRow1[icol] = pcoeffRow2[icol];
  72. pcoeffRow2[icol] = coeffT;
  73. }
  74. rhsT = rgrhs[irow1];
  75. rgrhs[irow1] = rgrhs[irow2];
  76. rgrhs[irow2] = rhsT;
  77. }
  78. __inline static void EliminateColumn(Double *rgcoeff, Double *rgrhs, Int crow,
  79. Int irowPiv)
  80. {
  81. Double *rgcoeffRowPiv = &rgcoeff[irowPiv * crow];
  82. Int irow;
  83. for (irow = irowPiv + 1; irow < crow; irow++)
  84. {
  85. Int icol;
  86. Double *rgcoeffRowCur = &rgcoeff[irow * crow];
  87. Double coeffMult;
  88. coeffMult = - (rgcoeffRowCur[irowPiv] / rgcoeffRowPiv[irowPiv]);
  89. for (icol = irowPiv + 1; icol < crow; icol++)
  90. rgcoeffRowCur[icol] += coeffMult * rgcoeffRowPiv[icol];
  91. rgrhs[irow] += coeffMult * rgrhs[irowPiv];
  92. }
  93. }
  94. __inline static void BackSub(Double *rgcoeff, Double *rgrhs, Int crow)
  95. {
  96. Int irow;
  97. for (irow = crow - 1; irow >= 0; irow--)
  98. {
  99. Double *rgcoeffRow = &rgcoeff[irow * crow];
  100. Double rhsRow = rgrhs[irow];
  101. Int icol;
  102. for (icol = irow + 1; icol < crow; icol++)
  103. rhsRow -= rgcoeffRow[icol] * rgrhs[icol];
  104. rgrhs[irow] = rhsRow / rgcoeffRow[irow];
  105. }
  106. }
  107. __inline static Int RowPivot(Double *rgcoeff, Int crow, Int irowBeg)
  108. {
  109. Int irow;
  110. Int irowPivot = irowBeg;
  111. Double coeffPivot = rgcoeff[irowBeg * crow + irowBeg];
  112. if (coeffPivot < 0.0f)
  113. coeffPivot = -coeffPivot;
  114. for (irow = irowBeg + 1; irow < crow; irow++)
  115. {
  116. Double coeffRow = rgcoeff[irow * crow + irowBeg];
  117. if (coeffRow < 0.0f)
  118. coeffRow = -coeffRow;
  119. if (coeffRow > coeffPivot)
  120. {
  121. coeffPivot = coeffRow;
  122. irowPivot = irow;
  123. }
  124. }
  125. if (coeffPivot == 0.0f)
  126. irowPivot = irowNull;
  127. return irowPivot;
  128. }
  129. Double* linearLS (Double** Ain, Double* b, UInt n_row, UInt n_col)
  130. {
  131. assert (n_row == n_col); // make sure of overdeterminancy
  132. Double* x = new Double [n_row + 1];
  133. Double* A = new Double [n_row * n_col];
  134. UInt count = 0;
  135. UInt i;
  136. for (i = 0; i < n_row; i++)
  137. for (UInt j = 0; j < n_col; j++)
  138. A[count++] = Ain[i][j];
  139. FSolveLinEq (A, b, n_row);
  140. for (i = 0; i < n_row; i++) {
  141. x[i] = b[i];
  142. }
  143. delete [] A;
  144. x [n_row] = 1.0;
  145. return x;
  146. }