#include "camd_internal.h"
GLOBAL size_t CAMD_aat
(
Int n,
const Int Ap [ ],
const Int Ai [ ],
Int Len [ ],
Int Tp [ ],
double Info [ ]
)
{
Int p1, p2, p, i, j, pj, pj2, k, nzdiag, nzboth, nz ;
double sym ;
size_t nzaat ;
#ifndef NDEBUG
CAMD_debug_init ("CAMD AAT") ;
for (k = 0 ; k < n ; k++) Tp [k] = EMPTY ;
ASSERT (CAMD_valid (n, n, Ap, Ai) == CAMD_OK) ;
#endif
if (Info != (double *) NULL)
{
for (i = 0 ; i < CAMD_INFO ; i++)
{
Info [i] = EMPTY ;
}
Info [CAMD_STATUS] = CAMD_OK ;
}
for (k = 0 ; k < n ; k++)
{
Len [k] = 0 ;
}
nzdiag = 0 ;
nzboth = 0 ;
nz = Ap [n] ;
for (k = 0 ; k < n ; k++)
{
p1 = Ap [k] ;
p2 = Ap [k+1] ;
CAMD_DEBUG2 (("\nAAT Column: "ID" p1: "ID" p2: "ID"\n", k, p1, p2)) ;
for (p = p1 ; p < p2 ; )
{
j = Ai [p] ;
if (j < k)
{
Len [j]++ ;
Len [k]++ ;
CAMD_DEBUG3 ((" upper ("ID","ID") ("ID","ID")\n", j,k, k,j));
p++ ;
}
else if (j == k)
{
p++ ;
nzdiag++ ;
break ;
}
else
{
break ;
}
ASSERT (Tp [j] != EMPTY) ;
ASSERT (Ap [j] <= Tp [j] && Tp [j] <= Ap [j+1]) ;
pj2 = Ap [j+1] ;
for (pj = Tp [j] ; pj < pj2 ; )
{
i = Ai [pj] ;
if (i < k)
{
Len [i]++ ;
Len [j]++ ;
CAMD_DEBUG3 ((" lower ("ID","ID") ("ID","ID")\n",
i,j, j,i)) ;
pj++ ;
}
else if (i == k)
{
pj++ ;
nzboth++ ;
break ;
}
else
{
break ;
}
}
Tp [j] = pj ;
}
Tp [k] = p ;
}
for (j = 0 ; j < n ; j++)
{
for (pj = Tp [j] ; pj < Ap [j+1] ; pj++)
{
i = Ai [pj] ;
Len [i]++ ;
Len [j]++ ;
CAMD_DEBUG3 ((" lower cleanup ("ID","ID") ("ID","ID")\n",
i,j, j,i)) ;
}
}
if (nz == nzdiag)
{
sym = 1 ;
}
else
{
sym = (2 * (double) nzboth) / ((double) (nz - nzdiag)) ;
}
nzaat = 0 ;
for (k = 0 ; k < n ; k++)
{
nzaat += Len [k] ;
}
CAMD_DEBUG1 (("CAMD nz in A+A', excluding diagonal (nzaat) = %g\n",
(double) nzaat)) ;
CAMD_DEBUG1 ((" nzboth: "ID" nz: "ID" nzdiag: "ID" symmetry: %g\n",
nzboth, nz, nzdiag, sym)) ;
if (Info != (double *) NULL)
{
Info [CAMD_STATUS] = CAMD_OK ;
Info [CAMD_N] = n ;
Info [CAMD_NZ] = nz ;
Info [CAMD_SYMMETRY] = sym ;
Info [CAMD_NZDIAG] = nzdiag ;
Info [CAMD_NZ_A_PLUS_AT] = nzaat ;
}
return (nzaat) ;
}