website/archive/binaries/mac/src/disembl/Tisean_3.0.1/source_c/routines/solvele.c

   1 /*
   2  *   This file is part of TISEAN
   3  *
   4  *   Copyright (c) 1998-2007 Rainer Hegger, Holger Kantz, Thomas Schreiber
   5  *
   6  *   TISEAN is free software; you can redistribute it and/or modify
   7  *   it under the terms of the GNU General Public License as published by
   8  *   the Free Software Foundation; either version 2 of the License, or
   9  *   (at your option) any later version.
  10  *
  11  *   TISEAN is distributed in the hope that it will be useful,
  12  *   but WITHOUT ANY WARRANTY; without even the implied warranty of
  13  *   MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  14  *   GNU General Public License for more details.
  15  *
  16  *   You should have received a copy of the GNU General Public License
  17  *   along with TISEAN; if not, write to the Free Software
  18  *   Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA  02110-1301  USA
  19  */
  20 /* Author: Rainer Hegger Last modified: Aug 14th, 1998 */
  21 #include <stdlib.h>
  22 #include <stdio.h>
  23 #include <math.h>
  24 #include "tisean_cec.h"
  25
  26 void solvele(double **mat,double *vec,unsigned int n)
  27 {
  28   double vswap,*mswap,*hvec,max,h,pivot,q;
  29   int i,j,k,maxi;
  30
  31   for (i=0;i<n-1;i++) {
  32     max=fabs(mat[i][i]);
  33     maxi=i;
  34     for (j=i+1;j<n;j++)
  35       if ((h=fabs(mat[j][i])) > max) {
  36         max=h;
  37         maxi=j;
  38       }
  39     if (maxi != i) {
  40       mswap=mat[i];
  41       mat[i]=mat[maxi];
  42       mat[maxi]=mswap;
  43       vswap=vec[i];
  44       vec[i]=vec[maxi];
  45       vec[maxi]=vswap;
  46     }
  47
  48     hvec=mat[i];
  49     pivot=hvec[i];
  50     if (fabs(pivot) == 0.0) {
  51       fprintf(stderr,"Singular matrix! Exiting!\n");
  52       exit(SOLVELE_SINGULAR_MATRIX);
  53     }
  54     for (j=i+1;j<n;j++) {
  55       q= -mat[j][i]/pivot;
  56       mat[j][i]=0.0;
  57       for (k=i+1;k<n;k++)
  58         mat[j][k] += q*hvec[k];
  59       vec[j] += q*vec[i];
  60     }
  61   }
  62   vec[n-1] /= mat[n-1][n-1];
  63   for (i=n-2;i>=0;i--) {
  64     hvec=mat[i];
  65     for (j=n-1;j>i;j--)
  66       vec[i] -= hvec[j]*vec[j];
  67     vec[i] /= hvec[i];
  68   }
  69 }