///
/// \brief Vespucci::Math::DimensionReduction::EstimateAdditiveNoise
/// \param noise
/// \param noise_correlation
/// \param sample
/// The slow additive noise mat::mator from the HySime paper. I'm looking into
/// faster ones.
void Vespucci::Math::DimensionReduction::EstimateAdditiveNoise(arma::mat &noise, arma::mat &noise_correlation, const arma::mat &sample)
{
double small = 1e-6;
noise = arma::zeros(sample.n_rows, sample.n_cols);
arma::mat RR = sample * sample.t();
arma::mat RRi = arma::inv(RR + small*arma::eye(sample.n_rows, sample.n_rows));
arma::mat XX, RRa, beta;
for (arma::uword i = 0; i < sample.n_rows; ++i){
XX = RRi - (RRi.col(i) * RRi.row(i))/RRi(i, i);
RRa = RR.col(i);
RRa(i) = 0;
beta = XX * RRa;
beta(i) = 0;
noise.row(i) = sample.row(i) - beta.t() * sample;
}
arma::mat nn = noise * noise.t() / sample.n_rows;
noise_correlation = arma::diagmat(nn.diag());
}
static int epat_test_proto( PIA *pi, char * scratch, int verbose )
{ int k, j, f, cc;
int e[2] = {0,0};
epat_connect(pi);
cc = RR(0xd);
epat_disconnect(pi);
epat_connect(pi);
for (j=0;j<2;j++) {
WRi(6,0xa0+j*0x10);
for (k=0;k<256;k++) {
WRi(2,k^0xaa);
WRi(3,k^0x55);
if (RRi(2) != (k^0xaa)) e[j]++;
}
}
epat_disconnect(pi);
f = 0;
epat_connect(pi);
WR(0x13,1); WR(0x13,0); WR(0xa,0x11);
epat_read_block(pi,scratch,512);
for (k=0;k<256;k++) {
if ((scratch[2*k] & 0xff) != k) f++;
if ((scratch[2*k+1] & 0xff) != (0xff-k)) f++;
}
epat_disconnect(pi);
if (verbose) {
#ifdef CONFIG_DEBUG_PRINTK
printk("%s: epat: port 0x%x, mode %d, ccr %x, test=(%d,%d,%d)\n",
pi->device,pi->port,pi->mode,cc,e[0],e[1],f);
#else
;
#endif
}
return (e[0] && e[1]) || f;
}
