/*=========================================================================
 *
 *  Copyright Insight Software Consortium
 *
 *  Licensed under the Apache License, Version 2.0 (the "License");
 *  you may not use this file except in compliance with the License.
 *  You may obtain a copy of the License at
 *
 *         http://www.apache.org/licenses/LICENSE-2.0.txt
 *
 *  Unless required by applicable law or agreed to in writing, software
 *  distributed under the License is distributed on an "AS IS" BASIS,
 *  WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
 *  See the License for the specific language governing permissions and
 *  limitations under the License.
 *
 *=========================================================================*/
/*=========================================================================
 *
 *  Portions of this file are subject to the VTK Toolkit Version 3 copyright.
 *
 *  Copyright (c) Ken Martin, Will Schroeder, Bill Lorensen
 *
 *  For complete copyright, license and disclaimer of warranty information
 *  please refer to the NOTICE file at the top of the ITK source tree.
 *
 *=========================================================================*/
#ifndef itkVectorConnectedComponentImageFilter_h
#define itkVectorConnectedComponentImageFilter_h

#include "itkMath.h"
#include "itkNumericTraits.h"
#include "itkConnectedComponentFunctorImageFilter.h"

namespace itk
{
namespace Functor
{
/** \class SimilarVectorsFunctor
 *
 *  \brief A connected components filter that labels the
 *         objects in a vector image.  Two vectors are pointing
 *         similar directions if one minus their dot product is less than a
 *         threshold.  Vectors that are 180 degrees out of phase
 *         are similar.  Assumes that vectors are normalized.
 * \ingroup ITKConnectedComponents
 */

template< typename TInput >
class SimilarVectorsFunctor
{
public:
  SimilarVectorsFunctor()
  { m_Threshold = itk::NumericTraits< typename TInput::ValueType >::ZeroValue(); }

  ~SimilarVectorsFunctor() = default;

  void SetDistanceThreshold(const typename TInput::ValueType & thresh)
  { m_Threshold = thresh; }
  typename TInput::ValueType GetDistanceThreshold() { return ( m_Threshold ); }

  bool operator!=(const SimilarVectorsFunctor &) const
  {
    return false;
  }

  bool operator==(const SimilarVectorsFunctor & other) const
  {
    return !( *this != other );
  }

  bool operator()(const TInput & a, const TInput & b) const
  {
    using RealValueType = typename NumericTraits<typename TInput::ValueType>::RealType;
    RealValueType dotProduct = NumericTraits<RealValueType>::ZeroValue();
    for ( unsigned int i = 0; i < NumericTraits<TInput>::GetLength(a); ++i)
      {
      dotProduct += a[i]*b[i];
      }
    return ( static_cast<typename TInput::ValueType>( 1.0 - itk::Math::abs(dotProduct) ) <= m_Threshold );
  }

protected:
  typename TInput::ValueType m_Threshold;
};
} // end namespace Functor

/** \class VectorConnectedComponentImageFilter
 *
 *  \brief A connected components filter that labels the
 *         objects in a vector image.  Two vectors are pointing
 *         similar directions if one minus their dot product is less than a
 *         threshold.  Vectors that are 180 degrees out of phase
 *         are similar.  Assumes that vectors are normalized.
 * \ingroup ITKConnectedComponents
 */
template< typename TInputImage, typename TOutputImage, typename TMaskImage = TInputImage >
class VectorConnectedComponentImageFilter:
  public ConnectedComponentFunctorImageFilter< TInputImage, TOutputImage,
                                               Functor::SimilarVectorsFunctor< typename TInputImage::ValueType >,
                                               TMaskImage >
{
public:
  ITK_DISALLOW_COPY_AND_ASSIGN(VectorConnectedComponentImageFilter);

  /** Standard class type aliases. */
  using Self = VectorConnectedComponentImageFilter;
  using Superclass = ConnectedComponentFunctorImageFilter< TInputImage, TOutputImage,
                                                Functor::SimilarVectorsFunctor< typename TInputImage::ValueType >,
                                                TMaskImage >;
  using Pointer = SmartPointer< Self >;
  using ConstPointer = SmartPointer< const Self >;

  /** Method for creation through the object factory. */
  itkNewMacro(Self);

  /** Run-time type information (and related methods). */
  itkTypeMacro(VectorConnectedComponentImageFilter, ConnectedComponentFunctorImageFilter);

  using InputValueType = typename TInputImage::PixelType::ValueType;

  virtual void SetDistanceThreshold(const InputValueType & thresh)
  { this->GetFunctor().SetDistanceThreshold(thresh); }

  virtual InputValueType GetDistanceThreshold()
  { return ( this->GetFunctor().GetDistanceThreshold() ); }

#ifdef ITK_USE_CONCEPT_CHECKING
  // Begin concept checking
  itkConceptMacro( InputValueHasNumericTraitsCheck,
                   ( Concept::HasNumericTraits< InputValueType > ) );
  itkConceptMacro( InputValyeTypeIsFloatingCheck,
                   ( Concept::IsFloatingPoint< InputValueType > ) );
  // End concept checking
#endif

protected:
  VectorConnectedComponentImageFilter() = default;
  ~VectorConnectedComponentImageFilter() override = default;
};
} // end namespace itk

#endif
