/*
 * This program source code file is part of KiCad, a free EDA CAD application.
 *
 * Copyright (C) 2013 CERN
 * @author Jacobo Aragunde Pérez
 * @author Tomasz Wlostowski <tomasz.wlostowski@cern.ch>
 *
 * This program is free software; you can redistribute it and/or
 * modify it under the terms of the GNU General Public License
 * as published by the Free Software Foundation; either version 2
 * of the License, or (at your option) any later version.
 *
 * This program is distributed in the hope that it will be useful,
 * but WITHOUT ANY WARRANTY; without even the implied warranty of
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 * GNU General Public License for more details.
 *
 * You should have received a copy of the GNU General Public License
 * along with this program; if not, you may find one here:
 * http://www.gnu.org/licenses/old-licenses/gpl-2.0.html
 * or you may search the http://www.gnu.org website for the version 2 license,
 * or you may write to the Free Software Foundation, Inc.,
 * 51 Franklin Street, Fifth Floor, Boston, MA  02110-1301, USA
 */

#ifndef __SHAPE_INDEX_H
#define __SHAPE_INDEX_H

#include <vector>
#include <geometry/shape.h>
#include <geometry/rtree.h>


/**
 * shapeFunctor template function
 *
 * It is used by SHAPE_INDEX to get a SHAPE* from another type.
 * By default relies on T::GetShape() method, should be specialized if the T object
 * doesn't allow that method.
 * @param object generic T object
 * @return a SHAPE* object equivalent to object.
 */
template <class T>
static const SHAPE* shapeFunctor( T aItem )
{
    return aItem->GetShape();
}

/**
 * shapeFunctor template function: specialization for T = SHAPE*
 */
template<>
const SHAPE* shapeFunctor( SHAPE* aItem )
{
    return aItem;
}

/**
 * boundingBox template method
 *
 * It is used by SHAPE_INDEX to get the bounding box of a generic T object.
 * By default relies on T::BBox() method, should be specialized if the T object
 * doesn't allow that method.
 * @param object generic T object
 * @return a BOX2I object containing the bounding box of the T object.
 */
template <class T>
BOX2I boundingBox( T object )
{
    return shapeFunctor(object)->BBox();
}

/**
 * acceptVisitor template method
 *
 * It is used by SHAPE_INDEX to implement Accept().
 * By default relies on V::operation() redefinition, should be specialized if V class
 * doesn't have its () operation defined to accept T objects.
 * @param object generic T object
 * @param visitor V visitor object
 */
template <class T, class V>
void acceptVisitor( T object, V visitor )
{
    visitor(object);
}

/**
 * collide template method
 *
 * It is used by SHAPE_INDEX to implement Query().
 * By default relies on T::Collide(U) method, should be specialized if the T object
 * doesn't allow that method.
 * @param object generic T object
 * @param anotherObject generic U object
 * @param minDistance minimum collision distance
 * @return if object and anotherObject collide
 */
template <class T, class U>
bool collide( T object, U anotherObject, int minDistance )
{
    return shapeFunctor(object)->Collide( anotherObject, minDistance );
}

template<class T, class V>
bool queryCallback(T shape, void* context) {
    V* visitor = (V*) context;
    acceptVisitor<T,V>(shape, *visitor);
    return true;
}

template <class T = SHAPE*>
class SHAPE_INDEX {

    public:

        SHAPE_INDEX();

        ~SHAPE_INDEX();

        /**
         * Function Add()
         *
         * Adds a SHAPE to the index.
         * @param shape the new SHAPE
         */
        void Add( T shape );

        /**
         * Function Remove()
         *
         * Removes a SHAPE to the index.
         * @param shape the new SHAPE
         */
        void Remove( T shape );

        /**
         * Function RemoveAll()
         *
         * Removes all the contents of the index.
         */
        void RemoveAll();

        /**
         * Function Accept()
         *
         * Accepts a visitor for every SHAPE object contained in this INDEX.
         * @param visitor Visitor object to be run
         */
        template<class V>
        void Accept( V visitor )
        {
            SHAPE_INDEX::Iterator iter = this->Begin();
            while(!iter.IsNull()) {
                T shape = *iter;
                acceptVisitor(shape, visitor);
                iter++;
            }
        }

        /**
         * Function Reindex()
         *
         * Rebuilds the index. This should be used if the geometry of the objects
         * contained by the index has changed.
         */
        void Reindex();

        /**
         * Function Query()
         *
         * Runs a callback on every SHAPE object contained in the bounding box of (shape).
         * @param shape shape to search against
         * @param minDistance distance threshold
         * @param visitor object to be invoked on every object contained in the search area.
         */

		template<class V>
        int Query( const SHAPE *shape, int minDistance, V& visitor, bool aExact )
        {
            BOX2I box = shape->BBox();
            box.Inflate(minDistance);
         
			int min[2] = {box.GetX(), 		box.GetY()};
            int max[2] = {box.GetRight(), 	box.GetBottom()};

			return this->m_tree->Search(min, max, visitor);   
        }

        class Iterator
        {
        private:

            typedef typename RTree<T, int, 2, float>::Iterator RTreeIterator;
            RTreeIterator iterator;

            /**
             * Function Init()
             *
             * Setup the internal tree iterator.
             * @param tree pointer to a RTREE object
             */
            void Init(RTree<T, int, 2, float>* tree) {
                tree->GetFirst(iterator);
            }

        public:

            /**
             * Iterator constructor
             *
             * Creates an iterator for the index object
             * @param index SHAPE_INDEX object to iterate
             */
            Iterator(SHAPE_INDEX* index) {
                Init(index->m_tree);
            }

            /**
             * Operator * (prefix)
             *
             * Returns the next data element.
             */
            T operator*() {
                return *iterator;
            }

            /**
             * Operator ++ (prefix)
             *
             * Shifts the iterator to the next element.
             */
            bool operator++() {
                return ++iterator;
            }

            /**
             * Operator ++ (postfix)
             *
             * Shifts the iterator to the next element.
             */
            bool operator++(int) {
                return ++iterator;
            }

            /**
             * Function IsNull()
             *
             * Checks if the iterator has reached the end.
             * @return true if it is in an invalid position (data finished)
             */
            bool IsNull() {
                return iterator.IsNull();
            }

            /**
             * Function IsNotNull()
             *
             * Checks if the iterator has not reached the end.
             * @return true if it is in an valid position (data not finished)
             */
            bool IsNotNull() {
                return iterator.IsNotNull();
            }

            /**
             * Function Next()
             *
             * Returns the current element of the iterator and moves to the next
             * position.
             * @return SHAPE object pointed by the iterator before moving to the
             *         next position.
             */
            T Next() {
                T object = *iterator;
                ++iterator;
                return object;
            }
        };

        /**
         * Function Begin()
         *
         * Creates an iterator for the current index object
         * @return iterator
         */
        Iterator Begin();

    private:

        RTree<T, int, 2, float>* m_tree;
};

/*
 * Class members implementation
 */

template<class T>
SHAPE_INDEX<T>::SHAPE_INDEX() {
    this->m_tree = new RTree<T, int, 2, float>();
}

template<class T>
SHAPE_INDEX<T>::~SHAPE_INDEX() {
    delete this->m_tree;
}

template<class T>
void SHAPE_INDEX<T>::Add(T shape) {
    BOX2I box = boundingBox(shape);
    int min[2]= {box.GetX(), box.GetY()};
    int max[2] = {box.GetRight(), box.GetBottom()};
    this->m_tree->Insert(min, max, shape);
}

template<class T>
void SHAPE_INDEX<T>::Remove(T shape) {
    BOX2I box = boundingBox(shape);
    int min[2]= {box.GetX(), box.GetY()};
    int max[2] = {box.GetRight(), box.GetBottom()};
    this->m_tree->Remove(min, max, shape);
}

template<class T>
void SHAPE_INDEX<T>::RemoveAll() {
    this->m_tree->RemoveAll();
}

template<class T>
void SHAPE_INDEX<T>::Reindex() {
    RTree<T, int, 2, float>* newTree;
    newTree = new RTree<T, int, 2, float>();

    SHAPE_INDEX::Iterator iter = this->Begin();
    while(!iter.IsNull()) {
        T shape = *iter;
        BOX2I box = boundingBox(shape);
        int min[2]= {box.GetX(), box.GetY()};
        int max[2] = {box.GetRight(), box.GetBottom()};
        newTree->Insert(min, max, shape);
        iter++;
    }
    delete this->m_tree;
    this->m_tree = newTree;
}

template<class T>
typename SHAPE_INDEX<T>::Iterator SHAPE_INDEX<T>::Begin() {
    return Iterator(this);
}


#endif