// Emacs: -*- C++ -*-

//
//	Copyright 1993, Center for Computer Vision and Visualization,
//	University of Florida.  All rights reserved.
//


//
// $Log: absorber,v $
// Revision 1.5  1994/01/31  15:50:18  thoth
// fixed typing error in invariant convolutions.
//
// Revision 1.4  1994/01/07  15:10:00  thoth
// Image class is now CoreImage and named image types are
// Image<P,T>.
//
// Revision 1.3  1993/12/29  17:33:18  thoth
// New operator scheme that prevents the need for trivial Image conversions.
//
// Revision 1.2  1993/11/17  18:29:46  thoth
// We now have support for forward convolutions.
// IPSIter is now PSIter<IntPoint>.
//
// Revision 1.1  1993/09/15  13:02:08  thoth
// Initial revision
//
// Revision 1.5  93/05/27  11:48:55  thoth
// Copyright Notices
// 
// Revision 1.4  93/04/29  11:20:56  thoth
// Faster(?) extension for VectorDIs.
// 
// Revision 1.3  93/04/17  18:56:44  jnw
// Fixed to match IA_IntPoint membername (dim)
// 
// Revision 1.2  93/04/08  13:21:59  thoth
// internal helper functions are now static.
// 
// Revision 1.1  93/03/18  11:39:42  thoth
// Initial revision
// 

#ifndef zero_extend_scan_IBTYPE
#define zero_extend_scan_IBTYPE

static void zero_extend_vec_scan(const IA_SetStructure &ss,
				 const IBTYPE **src,
				 IBTYPE **dest,
				 IBTYPE zero)
{
    for (unsigned i=0; i<ss.nintervals(); i++) {
	IA_ss_interval	temp(ss.retrieve_interval(i));
	if (temp.substructure == IA_SetStructure::FIRST_ONLY) {
	    (*src) += temp.count;
	} else if (temp.substructure == IA_SetStructure::BOTH) {
	    for (unsigned j=0; j<temp.count; j++) {
		*((*dest)++) = *((*src)++);
	    }
	} else if (temp.substructure == IA_SetStructure::SECOND_ONLY) {
	    for (unsigned j=0; j<temp.count; j++)
		*((*dest)++) = zero;
	} else {
	    for (unsigned j=0; j<temp.count; j++)
		zero_extend_vec_scan(temp.substructure, src, dest, zero);
	}
    }
}

static void zero_extend_iter_scan(const IA_SetStructure &ss,
				  IA_IVIter<IA_IntPoint,IBTYPE> *srciter,
				  IBTYPE **dest,
				  IBTYPE zero)
{
    for (unsigned i=0; i<ss.nintervals(); i++) {
	IA_ss_interval	temp(ss.retrieve_interval(i));
	if (temp.substructure == IA_SetStructure::FIRST_ONLY) {
	    IBTYPE	blah;
	    for (unsigned j=0; j<temp.count; j++) 
		(*srciter)(blah);
	} else if (temp.substructure == IA_SetStructure::BOTH) {
	    IBTYPE	blah;
	    for (unsigned j=0; j<temp.count; j++) {
		(*srciter)(blah);
		*((*dest)++) = blah;
	    }
	} else if (temp.substructure == IA_SetStructure::SECOND_ONLY) {
	    for (unsigned j=0; j<temp.count; j++)
		*((*dest)++) = zero;
	} else {
	    for (unsigned j=0; j<temp.count; j++)
		zero_extend_iter_scan(temp.substructure, srciter, dest, zero);
	}
    }
}

static void zero_extend(const IA_CoreImage<IA_IntPoint,IBTYPE> &srcimg,
			const IA_IntPointSet &dest_ps, IBTYPE *dest_data,
			IBTYPE zero)
{
    IA_SetStructure	ss;
    intersect_with_dualstruct(srcimg.domain(), dest_ps, &ss);

    if (srcimg.type() == IA_VectorI<IA_IntPoint,IBTYPE>::s_type()) {
	IBTYPE	*srcdata = ((IA_VectorI<IA_IntPoint,IBTYPE>*)srcimg.bip)->vec;
	zero_extend_vec_scan(ss, &srcdata, &dest_data, zero);
    } else {
	IA_IVIter<IA_IntPoint,IBTYPE>	iter(srcimg);
	zero_extend_iter_scan(ss, &iter, &dest_data, zero);
    }
}

#endif

//
// backward convolutions
//

static IA_Image<IA_IntPoint,RTYPE>
backw_CONV_inv_core(IA_IntPoint src_infimum,
	      IA_IntPoint src_width,
	      const IBTYPE *src_data, // length is prod(src_width)
	      const IA_Image<IA_IntPoint,TBTYPE> &templ,
	      IA_IntPointSet dest_ps)
{
    const int	dimen = src_width.dim();

    IA_IntPointSet	templ_ps = templ.domain();
    int		templ_sz = templ_ps.card();
    TBTYPE	*const templ_data = new TBTYPE[templ_sz];
    int	*const templ_offsets = new int[templ_sz];

    {
	TBTYPE	*d_scan = templ_data;
	int	*o_scan = templ_offsets;
	IA_IPIter<IA_IntPoint,TBTYPE>	iter(templ);
	IA_IntPoint	ip;
	while (iter(ip, *d_scan)) {
	    *o_scan = ip[0];
	    for (unsigned i=1; i<dimen; i++) {
		*o_scan *= src_width[i];
		*o_scan += ip[i];
	    }
	    d_scan++;
	    o_scan++;
	}
    }

    IA_PSIter<IA_IntPoint>	iter(dest_ps);
    IA_IntPoint	ip;
    RTYPE *const	dest_data = new RTYPE[dest_ps.card()];
    RTYPE *	valp = dest_data;
    while (iter(ip)) {
	int	offset= ip[0] - src_infimum[0];
	unsigned i;
	for (i=1; i<dimen; i++) {
	    offset *= src_width[i];
	    offset += ip[i] - src_infimum[i];
	}
	const IBTYPE *const base = src_data + offset;

	// _IVAL_=(base[templ_offsets[i]])
	// _TVAL_=(templ_data[i])
	// _IRESULT_=(*valp)

	INITIALIZE ;

	for (i=0; i<templ_sz; i++) {
	    ACCUMULATE ;
	}
	{
	    RESULT ;
	}
	valp++;
    }
    delete[] templ_offsets;
    delete[] templ_data;

    return IA_Image<IA_IntPoint,RTYPE>(dest_ps, dest_data, dest_ps.card(), 1);
}

static IA_Image<IA_IntPoint,RTYPE>
backw_CONV_inv(const IA_Image<IA_IntPoint,IBTYPE> &img,
	 const IA_Image<IA_IntPoint,TBTYPE> &invtempl,
	 IA_IntPointSet dest_ps)
{
    IA_IntPoint	inf_ = dest_ps.inf()+invtempl.domain().inf();
    IA_IntPoint	sup_ = dest_ps.sup()+invtempl.domain().sup();
    IA_IntPointSet	src_ps = IA_IntPointSet(inf_,sup_);

    IBTYPE	*const src_data = new IBTYPE[src_ps.card()];

    zero_extend(img, src_ps, src_data, ZERO);
    IA_Image<IA_IntPoint,RTYPE>	rval =
	backw_CONV_inv_core(inf_, sup_-inf_ + 1, src_data, invtempl, dest_ps);

    delete[] src_data;

    return rval;
}

IA_Image<IA_IntPoint,RTYPE>
CONV(const IA_CoreImage<IA_IntPoint,IBTYPE> &img_,
     const IA_DDTemplate<TITYPE> &templ,
     IA_IntPointSet dest_ps)
{
    IA_Image<IA_IntPoint,IBTYPE>	img(img_);

    if (templ.type() == IA_InvariantDT<TITYPE>::s_type()) {
	return backw_CONV_inv
	    (img, ((IA_InvariantDT<TITYPE>*)templ.bdtp)->value, dest_ps);
    } else {
	RTYPE *const	dest_data = new RTYPE[dest_ps.card()];
	RTYPE	*valp = dest_data;
	IA_PSIter<IA_IntPoint>	dest_iter(dest_ps);
	IA_IntPoint	base_ip;
	while (dest_iter(base_ip)) {
	    IA_CoreImage<IA_IntPoint,TBTYPE>	tv = templ(base_ip);

	    IA_IPIter<IA_IntPoint,TBTYPE>	templ_iter(tv);
	    IA_IntPoint	templ_ip;
	    TBTYPE	templ_val;

	    // _IVAL_=img(ip)
	    // _TVAL_=templ_val
	    // _IRESULT_=(*valp)

	    INITIALIZE ;

	    while ( templ_iter(templ_ip, templ_val) ) {
		const IA_IntPoint	ip = templ_ip; //+base_ip;
		if (! img.domain().contains(ip))
		    continue;
		ACCUMULATEVAR ;
	    }
	    {
		RESULT ;
	    }
	    valp++;
	}
	return IA_Image<IA_IntPoint,RTYPE>(dest_ps, dest_data,
					   dest_ps.card(), 1);
    }
}

//
// foward convolutions
//

static IA_Image<IA_IntPoint,RTYPE>
forw_CONV_inv_core(IA_IntPoint src_infimum,
	      IA_IntPoint src_width,
	      const IBTYPE *src_data, // length is prod(src_width)
	      const IA_Image<IA_IntPoint,TBTYPE> &templ,
	      IA_IntPointSet dest_ps)
{
    const int	dimen = src_width.dim();

    IA_IntPointSet	templ_ps = templ.domain();
    int		templ_sz = templ_ps.card();
    TBTYPE	*const templ_data = new TBTYPE[templ_sz];
    int	*const templ_offsets = new int[templ_sz];

    {
	TBTYPE	*d_scan = templ_data;
	int	*o_scan = templ_offsets;
	IA_IPIter<IA_IntPoint,TBTYPE>	iter(templ);
	IA_IntPoint	ip;
	while (iter(ip, *d_scan)) {
	    *o_scan = -ip[0];
	    for (unsigned i=1; i<dimen; i++) {
		*o_scan *= src_width[i];
		*o_scan -= ip[i];
	    }
	    d_scan++;
	    o_scan++;
	}
    }

    IA_PSIter<IA_IntPoint>	iter(dest_ps);
    IA_IntPoint	ip;
    RTYPE *const	dest_data = new RTYPE[dest_ps.card()];
    RTYPE *	valp = dest_data;
    while (iter(ip)) {
	int	offset= ip[0] - src_infimum[0];
	unsigned i;
	for (i=1; i<dimen; i++) {
	    offset *= src_width[i];
	    offset += ip[i] - src_infimum[i];
	}
	const IBTYPE *const base = src_data + offset;

	// _IVAL_=(base[templ_offsets[i]])
	// _TVAL_=(templ_data[i])
	// _IRESULT_=(*valp)

	INITIALIZE ;

	for (i=0; i<templ_sz; i++) {
	    ACCUMULATE ;
	}
	{
	    RESULT ;
	}
	valp++;
    }
    delete[] templ_offsets;
    delete[] templ_data;

    return IA_Image<IA_IntPoint,RTYPE>(dest_ps, dest_data, dest_ps.card(), 1);
}

static
IA_Image<IA_IntPoint,RTYPE>
forw_CONV_inv(const IA_Image<IA_IntPoint,IBTYPE> &img,
	const IA_Image<IA_IntPoint,TBTYPE> &invtempl,
	IA_IntPointSet dest_ps)
{
    IA_IntPoint	inf_ = dest_ps.inf()-invtempl.domain().sup();
    IA_IntPoint	sup_ = dest_ps.sup()-invtempl.domain().inf();
    IA_IntPointSet	src_ps = IA_IntPointSet(inf_,sup_);

    IBTYPE	*const src_data = new IBTYPE[src_ps.card()];

    zero_extend(img, src_ps, src_data, ZERO);
    IA_Image<IA_IntPoint,RTYPE>	rval =
	forw_CONV_inv_core(inf_, sup_-inf_ + 1, src_data, invtempl, dest_ps);

    delete[] src_data;

    return rval;
}

IA_Image<IA_IntPoint,RTYPE>
CONV(const IA_DDTemplate<TITYPE> &templ,
     const IA_CoreImage<IA_IntPoint,IBTYPE> &img_,
     IA_IntPointSet dest_ps)
{
    IA_Image<IA_IntPoint,IBTYPE>	img(img_);

    if (templ.type() == IA_InvariantDT<TITYPE>::s_type()) {
	return forw_CONV_inv
	    (img, ((IA_InvariantDT<TITYPE>*)templ.bdtp)->value, dest_ps);
    } else {
	unsigned	size = dest_ps.card();
	RTYPE *const	dest_data = new RTYPE[size];

	for (int i=0; i<size; i++) {
	    // _IRESULT_=dest_data[i]
	    FORW_INITIALIZE ;
	}

	IA_PSIter<IA_IntPoint>	src_iter(img.domain());
	IA_IntPoint	base_ip;
	while (src_iter(base_ip)) {
	    IA_CoreImage<IA_IntPoint,TBTYPE>	tv = templ(base_ip);

	    IA_IPIter<IA_IntPoint,TBTYPE>	templ_iter(tv);
	    IA_IntPoint	templ_ip;
	    TBTYPE	templ_val;
	    IBTYPE	ival = img(base_ip);

	    // _IVAL_=ival
	    // _TVAL_=templ_val
	    // _IRESULT_=(*valp)

	    while ( templ_iter(templ_ip, templ_val) ) {
		const IA_IntPoint	ip = templ_ip; //+base_ip;
		if (! dest_ps.contains(templ_ip))
		    continue;
		unsigned	offset = dest_ps.index(templ_ip);
		RTYPE	*valp = dest_data + offset;
//		cout << "templ(" << base_ip << ") =  " << tv << " and templ()("
//		     << templ_ip <<") = " << templ_val << endl;
		FORW_ACCUMULATEVAR ;
	    }
	}
	return IA_Image<IA_IntPoint,RTYPE>(dest_ps, dest_data,
						      size, 1);
    }
}
