/*=========================================================================
 *
 *  Copyright UMC Utrecht and contributors
 *
 *  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.
 *
 *=========================================================================*/
#ifndef itkANNFixedRadiusTreeSearch_hxx
#define itkANNFixedRadiusTreeSearch_hxx

#include "itkANNFixedRadiusTreeSearch.h"

namespace itk
{

/**
 * ************************ Constructor *************************
 */

template <typename TBinaryTree>
ANNFixedRadiusTreeSearch<TBinaryTree>::ANNFixedRadiusTreeSearch()
{
  this->m_ErrorBound = 0.0;
  this->m_SquaredRadius = 0.0;
} // end Constructor


/**
 * ************************ Search *************************
 */

template <typename TBinaryTree>
void
ANNFixedRadiusTreeSearch<TBinaryTree>::Search(const MeasurementVectorType & qp,
                                              IndexArrayType &              ind,
                                              DistanceArrayType &           dists)
{
  /** Get k , dim and eps. */
  int    k = static_cast<int>(this->m_KNearestNeighbors);
  int    dim = static_cast<int>(this->m_DataDimension);
  double eps = this->m_ErrorBound;
  double sqRad = this->m_SquaredRadius;

  /** Allocate memory for ANN indices and distances arrays. */
  ANNIndexArrayType ANNIndices = new ANNIndexType[k];

  ANNDistanceArrayType ANNDistances = new ANNDistanceType[k];

  /** Alocate memory for ANN query point and copy qp to it. */
  ANNPointType ANNQueryPoint = annAllocPt(dim);
  for (int i = 0; i < dim; ++i)
  {
    ANNQueryPoint[i] = qp[i];
  }

  /** The actual ANN search. */
  this->m_BinaryTreeAsITKANNType->GetANNTree()->annkFRSearch(ANNQueryPoint, sqRad, k, ANNIndices, ANNDistances, eps);
  // this->m_BinaryTree->GetANNTree()->annkFRSearch(
  // ANNQueryPoint, sqRad, k, ANNIndices, ANNDistances, eps );

  /** Set the ANNIndices and ANNDistances in the corresponding itk::Array's.
   * Memory management is transfered to these itk::Array's, which have SmartPointers
   * and therefore don't have to be regarded anymore. No deallocation of
   * ANNIndices and ANNDistances is needed now.
   */
  ind.SetData(ANNIndices, k, true);
  dists.SetData(ANNDistances, k, true);

  /** Deallocate the temporary ANNQueryPoint. */
  annDeallocPt(ANNQueryPoint);

} // end Search


/**
 * ************************ Search *************************
 */

template <typename TBinaryTree>
void
ANNFixedRadiusTreeSearch<TBinaryTree>::Search(const MeasurementVectorType & qp,
                                              IndexArrayType &              ind,
                                              DistanceArrayType &           dists,
                                              double                        sqRad)
{
  /** Get k , dim and eps. */
  int    k = static_cast<int>(this->m_KNearestNeighbors);
  int    dim = static_cast<int>(this->m_DataDimension);
  double eps = this->m_ErrorBound;

  /** Allocate memory for ANN indices and distances arrays. */
  ANNIndexArrayType ANNIndices = new ANNIndexType[k];

  ANNDistanceArrayType ANNDistances = new ANNDistanceType[k];

  /** Alocate memory for ANN query point and copy qp to it. */
  ANNPointType ANNQueryPoint = annAllocPt(dim);
  for (int i = 0; i < dim; ++i)
  {
    ANNQueryPoint[i] = qp[i];
  }

  /** The actual ANN search. */
  this->m_BinaryTreeAsITKANNType->GetANNTree()->annkFRSearch(ANNQueryPoint, sqRad, k, ANNIndices, ANNDistances, eps);
  // this->m_BinaryTree->GetANNTree()->annkFRSearch(
  // ANNQueryPoint, sqRad, k, ANNIndices, ANNDistances, eps );

  /** Set the ANNIndices and ANNDistances in the corresponding itk::Array's.
   * Memory management is transfered to these itk::Array's, which have SmartPointers
   * and therefore don't have to be regarded anymore. No deallocation of
   * ANNIndices and ANNDistances is needed now.
   */
  ind.SetData(ANNIndices, k, true);
  dists.SetData(ANNDistances, k, true);

  /** Deallocate the temporary ANNQueryPoint. */
  annDeallocPt(ANNQueryPoint);

} // end Search


} // end namespace itk

#endif // end #ifndef itkANNFixedRadiusTreeSearch_hxx
