56 lines
1.3 KiB
C++
56 lines
1.3 KiB
C++
#include "nr.h"
|
|
|
|
void NR::mrqmin(Vec_I_DP &x, Vec_I_DP &y, Vec_I_DP &sig, Vec_IO_DP &a,
|
|
Vec_I_BOOL &ia, Mat_O_DP &covar, Mat_O_DP &alpha, DP &chisq,
|
|
void funcs(const DP, Vec_I_DP &, DP &, Vec_O_DP &), DP &alamda)
|
|
{
|
|
static int mfit;
|
|
static DP ochisq;
|
|
int j,k,l;
|
|
|
|
int ma=a.size();
|
|
static Mat_DP oneda(ma,1);
|
|
static Vec_DP atry(ma),beta(ma),da(ma);
|
|
if (alamda < 0.0) {
|
|
mfit=0;
|
|
for (j=0;j<ma;j++)
|
|
if (ia[j]) mfit++;
|
|
alamda=0.001;
|
|
mrqcof(x,y,sig,a,ia,alpha,beta,chisq,funcs);
|
|
ochisq=chisq;
|
|
for (j=0;j<ma;j++) atry[j]=a[j];
|
|
}
|
|
Mat_DP temp(mfit,mfit);
|
|
for (j=0;j<mfit;j++) {
|
|
for (k=0;k<mfit;k++) covar[j][k]=alpha[j][k];
|
|
covar[j][j]=alpha[j][j]*(1.0+alamda);
|
|
for (k=0;k<mfit;k++) temp[j][k]=covar[j][k];
|
|
oneda[j][0]=beta[j];
|
|
}
|
|
gaussj(temp,oneda);
|
|
for (j=0;j<mfit;j++) {
|
|
for (k=0;k<mfit;k++) covar[j][k]=temp[j][k];
|
|
da[j]=oneda[j][0];
|
|
}
|
|
if (alamda == 0.0) {
|
|
covsrt(covar,ia,mfit);
|
|
covsrt(alpha,ia,mfit);
|
|
return;
|
|
}
|
|
for (j=0,l=0;l<ma;l++)
|
|
if (ia[l]) atry[l]=a[l]+da[j++];
|
|
mrqcof(x,y,sig,atry,ia,covar,da,chisq,funcs);
|
|
if (chisq < ochisq) {
|
|
alamda *= 0.1;
|
|
ochisq=chisq;
|
|
for (j=0;j<mfit;j++) {
|
|
for (k=0;k<mfit;k++) alpha[j][k]=covar[j][k];
|
|
beta[j]=da[j];
|
|
}
|
|
for (l=0;l<ma;l++) a[l]=atry[l];
|
|
} else {
|
|
alamda *= 10.0;
|
|
chisq=ochisq;
|
|
}
|
|
}
|