/****************************************************************************
 Copyright (C) 2010-2012 the Office National des Forêts (ONF), France
                         All rights reserved.

 Contact : alexandre.piboule@onf.fr

 Developers : Alexandre PIBOULE (ONF)

 This file is part of PluginONF library.

 PluginONF is free library: you can redistribute it and/or modify
 it under the terms of the GNU Lesser General Public License as published by
 the Free Software Foundation, either version 3 of the License, or
 (at your option) any later version.

 PluginONF 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 Lesser General Public License
 along with PluginONF.  If not, see <http://www.gnu.org/licenses/lgpl.html>.
*****************************************************************************/

#ifndef ONF_STEPMERGECLUSTERSFROMPOSITIONS02_H
#define ONF_STEPMERGECLUSTERSFROMPOSITIONS02_H

#include "ct_step/abstract/ct_abstractstep.h"

#include "ct_itemdrawable/ct_point2d.h"
#include "ct_itemdrawable/ct_pointcluster.h"
#include "ct_itemdrawable/ct_scene.h"
#include "ct_itemdrawable/ct_image2d.h"

#include "documentinterface.h"

class ONF_StepMergeClustersFromPositions02: public CT_AbstractStep
{
    Q_OBJECT
    using SuperClass = CT_AbstractStep;

public:

    class ClusterData
    {
    public:

        ClusterData()
        {

        }

        ClusterData(const CT_PointCluster* cluster, double distance, const CT_Point2D* position, const CT_PointCluster* positionCluster)
        {
            _cluster = cluster;
            _distance = distance;
            _position = position;
            _positionCluster = positionCluster;
        }

        const CT_PointCluster* _cluster;
        double                  _distance;
        const CT_Point2D*      _position;
        const CT_PointCluster* _positionCluster;

        const Eigen::Vector3d& center() {return _cluster->centerCoordinate();}

        bool operator < (const ClusterData& cld) const
        {
            return (_distance < cld._distance);
        }
    };

    ONF_StepMergeClustersFromPositions02();

    QString description() const override;
    QString detailledDescription() const override;
    QString inputDescription() const override;
    QString outputDescription() const override;
    QString detailsDescription() const override;

    QString URL() const override;

    CT_VirtualAbstractStep* createNewInstance() const final;

protected:

    void declareInputModels(CT_StepInModelStructureManager& manager) final;

    void fillPostInputConfigurationDialog(CT_StepConfigurableDialog* postInputConfigDialog) final;

//    void preProcessCreateOutResultModelListProtected();

    void declareOutputModels(CT_StepOutModelStructureManager& manager) final;

    void compute() final;

    void initManualMode() override;
    void useManualMode(bool quit) override;

private:

    CT_HandleInResultGroup<>                                                            _inRclusters;
    CT_HandleInStdZeroOrMoreGroup                                                       _inZeroOrMoreRootGroupClusters;
    CT_HandleInStdGroup<>                                                               _inGrpClusters;
    CT_HandleInSingularItem<CT_PointCluster>                                            _inCluster;

    CT_HandleInResultGroupCopy<>                                                        _inRPos;
    CT_HandleInStdZeroOrMoreGroup                                                       _inZeroOrMoreRootGroupPos;
    CT_HandleInStdGroup<>                                                               _inGrpPos;
    CT_HandleInSingularItem<CT_Point2D>                                                 _inPosition;

    CT_HandleInResultGroup<0>                                                           _inRMNT;
    CT_HandleInStdZeroOrMoreGroup                                                       _inZeroOrMoreRootGroupMNT;
    CT_HandleInStdGroup<>                                                               _inGrpMNT;
    CT_HandleInSingularItem<CT_Image2D<float>>                                          _inMNT;

    CT_HandleOutStdGroup                                                                _outGroup;
    CT_HandleOutSingularItem<CT_Scene>                                                  _outScene;
    CT_HandleOutStdItemAttribute<double>                                                _outSceneZRef;

    QMap<const CT_PointCluster*, const CT_StandardItemGroup*> _clustersGroups;

    // Step parameters
    bool    _interactiveMode;
    double  _dMax;
    double  _hRef;
    QList<CT_AbstractItemDrawable*>                             m_itemDrawableSelected;
    DocumentInterface                                           *m_doc;
    int                                                         m_status;

    QMap<const CT_Point2D*, QPair<CT_PointCloudIndexVector*, QList<const CT_PointCluster*>* > > _positionsData;
    QMultiMap<const CT_PointCluster*, const CT_PointCluster*> _clusterToCluster;
    QList<const CT_PointCluster*>                       _trash;

    static void addPointsToScenes(QPair<CT_PointCloudIndexVector *, QList<const CT_PointCluster *> *> &pair);

    inline static double squareDist(const Eigen::Vector3d &v1, const Eigen::Vector3d &v2)
    {
        return (v1(0) - v2(0))*(v1(0) - v2(0)) + (v1(1) - v2(1))*(v1(1) - v2(1)) + (v1(2) - v2(2))*(v1(2) - v2(2));
    }

};

#endif // ONF_STEPMERGECLUSTERSFROMPOSITIONS02_H