/* returns 0 if successful */
/* returns -1 if ill-conditioned matrix */
/*------------------------------------------------------*/
-#ifdef HAVE_CONFIG_H
#include "config.h"
-#endif
#include <math.h>
#include <stdlib.h>
#include "xmalloc.h"
+#include "gaussjordan.h"
+
#define SMALL 0.00001
int firm_gaussjordansolve(double *A, double *vec, int nsize)
x[i] = i;
/* triangularize A */
- /* ie A has zeros below it's diagonal */
+ /* ie A has zeros below its diagonal */
for (col = 0; col < nsize - 1; ++col) {
big = 0;
/* find the largest left in LRH box */
}
/* swap rows */
- for(i=0;i<nsize;i++) {
+ for (i=0;i<nsize;i++) {
temp = _A(col,i);
_A(col,i) = _A(biggest_r,i);
_A(biggest_r,i) = temp;
vec[biggest_r] = temp;
/* swap columns */
- for(i=0;i<nsize;i++) {
+ for (i=0;i<nsize;i++) {
temp = _A(i,col);
_A(i,col) = _A(i,biggest_c);
_A(i,biggest_c) = temp;
/* partially annihilate this col */
/* zero columns below diag */
- for(row=col+1;row<nsize;row++) {
+ for (row=col+1;row<nsize;row++) {
/* changes during calc */
temp = _A(row,col) / _A(col,col);
/* annihilates A[][] */
- for(i=col;i<nsize;i++)
+ for (i=col;i<nsize;i++)
_A(row,i) = _A(row,i) - temp * _A(col,i);
/* same op on vec */
scramvec[nsize - 1] = vec[nsize - 1] / _A(nsize - 1,nsize - 1);
/* answer needs sorting */
- for(i=nsize-2;i>=0;i--) {
+ for (i=nsize-2;i>=0;i--) {
sum = 0;
- for(j=i+1;j<nsize;j++)
+ for (j=i+1;j<nsize;j++)
sum = sum + _A(i,j) * scramvec[j];
scramvec[i] = (vec[i] - sum) / _A(i,i);
}
/* reorder unknowns--return in vec */
- for(i=0;i<nsize;i++) {
+ for (i=0;i<nsize;i++) {
j = x[i];
vec[j] = scramvec[i];
}