#include "cs.h"
/* find nonzero pattern of Cholesky L(k,1:k-1) using etree and triu(A(:,k)) */
int cs_ereach (const cs *A, int k, const int *parent, int *s, int *w)
{
    int i, p, n, len, top, *Ap, *Ai ;
    if (!CS_CSC (A) || !parent || !s || !w) return (-1) ;   /* check inputs */
    top = n = A->n ; Ap = A->p ; Ai = A->i ;
    CS_MARK (w, k) ;		    /* mark node k as visited */
    for (p = Ap [k] ; p < Ap [k+1] ; p++)
    {
	i = Ai [p] ;		    /* A(i,k) is nonzero */
	if (i > k) continue ;	    /* only use upper triangular part of A */
	for (len = 0 ; !CS_MARKED (w,i) ; i = parent [i]) /* traverse up etree*/
	{
	    s [len++] = i ;	    /* L(k,i) is nonzero */
	    CS_MARK (w, i) ;	    /* mark i as visited */
	}
	while (len > 0) s [--top] = s [--len] ; /* push path onto stack */
    }
    for (p = top ; p < n ; p++) CS_MARK (w, s [p]) ;	/* unmark all nodes */
    CS_MARK (w, k) ;		    /* unmark node k */
    return (top) ;		    /* s [top..n-1] contains pattern of L(k,:)*/
}