home *** CD-ROM | disk | FTP | other *** search
/ Computer Shopper 242 / Issue 242 - April 2008 - DPCS0408DVD.ISO / Software Money Savers / VirtualDub / Source / VirtualDub-1.7.7-src.7z / src / system / source / vectors.cpp < prev    next >
Encoding:
C/C++ Source or Header  |  2007-08-14  |  2.1 KB  |  78 lines

  1. //    VirtualDub - Video processing and capture application
  2. //    System library component
  3. //    Copyright (C) 1998-2004 Avery Lee, All Rights Reserved.
  4. //
  5. //    Beginning with 1.6.0, the VirtualDub system library is licensed
  6. //    differently than the remainder of VirtualDub.  This particular file is
  7. //    thus licensed as follows (the "zlib" license):
  8. //
  9. //    This software is provided 'as-is', without any express or implied
  10. //    warranty.  In no event will the authors be held liable for any
  11. //    damages arising from the use of this software.
  12. //
  13. //    Permission is granted to anyone to use this software for any purpose,
  14. //    including commercial applications, and to alter it and redistribute it
  15. //    freely, subject to the following restrictions:
  16. //
  17. //    1.    The origin of this software must not be misrepresented; you must
  18. //        not claim that you wrote the original software. If you use this
  19. //        software in a product, an acknowledgment in the product
  20. //        documentation would be appreciated but is not required.
  21. //    2.    Altered source versions must be plainly marked as such, and must
  22. //        not be misrepresented as being the original software.
  23. //    3.    This notice may not be removed or altered from any source
  24. //        distribution.
  25.  
  26. #include "stdafx.h"
  27. #include <vd2/system/vdstl.h>
  28. #include <vd2/system/vectors.h>
  29.  
  30. bool VDSolveLinearEquation(double *src, int n, ptrdiff_t stride_elements, double *b, double tolerance) {
  31.     vdfastvector<double *> array(n);
  32.     double **m = &array[0];
  33.     int i, j, k;
  34.  
  35.     for(i=0; i<n; ++i) {
  36.         m[i] = src;
  37.         src += stride_elements;
  38.     }
  39.  
  40.     // factor U
  41.     for(i=0; i<n; ++i) {
  42.         int best = i;
  43.  
  44.         for(j=i+1; j<n; ++j) {
  45.             if (fabs(m[best][i]) < fabs(m[j][i]))
  46.                 best = j;
  47.         }
  48.  
  49.         std::swap(m[i], m[best]);
  50.         std::swap(b[i], b[best]);
  51.  
  52.         if (fabs(m[i][i]) < tolerance)
  53.             return false;
  54.  
  55.         double f = 1.0 / m[i][i];
  56.  
  57.         m[i][i] = 1.0;
  58.  
  59.         for(j=i+1; j<n; ++j)
  60.             m[i][j] *= f;
  61.  
  62.         b[i] *= f;
  63.  
  64.         for(j=i+1; j<n; ++j) {
  65.             b[j] -= b[i] * m[j][i];
  66.             for(k=n-1; k>=i; --k)
  67.                 m[j][k] -= m[i][k] * m[j][i];
  68.         }
  69.     }
  70.  
  71.     // factor L
  72.     for(i=n-1; i>=0; --i)
  73.         for(j=i-1; j>=0; --j)
  74.             b[j] -= b[i] * m[j][i];
  75.  
  76.     return true;
  77. }
  78.