/*=========================================================================
 *
 *  Copyright NumFOCUS
 *
 *  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
 *
 *         https://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.
 *
 *=========================================================================*/

#include "itkApproximateSignedDistanceMapImageFilter.h"
#include "itkShiftScaleImageFilter.h"
#include "itkImageFileWriter.h"
#include "itkNumericTraits.h"
#include "itkTestingMacros.h"


// Anonymous namespace
namespace
{

// Simple signed distance function
template <typename TPoint>
double
SimpleSignedDistance(const TPoint & p)
{
  auto             center = itk::MakeFilled<TPoint>(32);
  constexpr double radius{ 16 };

  double accum = 0.0;
  for (unsigned int j = 0; j < TPoint::PointDimension; ++j)
  {
    accum += itk::Math::sqr(p[j] - center[j]);
  }
  accum = std::sqrt(accum);
  return accum - radius;
}

} // namespace

int
itkApproximateSignedDistanceMapImageFilterTest(int argc, char * argv[])
{
  if (argc < 3)
  {
    std::cerr << "Missing parameters" << std::endl;
    std::cerr << "Usage: " << itkNameOfTestExecutableMacro(argv) << " insideValue outputImage" << std::endl;
    return EXIT_FAILURE;
  }

  constexpr unsigned int ImageDimension{ 2 };

  using InputPixelType = unsigned int;
  using OutputPixelType = float;
  using WriterPixelType = short;
  using PointPixelType = double;

  using InputImageType = itk::Image<InputPixelType, ImageDimension>;
  using OutputImageType = itk::Image<OutputPixelType, ImageDimension>;
  using WriterImageType = itk::Image<WriterPixelType, ImageDimension>;
  using PointType = itk::Point<PointPixelType, ImageDimension>;

  // Make a binary input image based on the signed distance function
  // using the inside and outside values
  const InputPixelType     insideValue = std::stoi(argv[1]);
  constexpr InputPixelType outsideValue{ 0 };

  auto                             image = InputImageType::New();
  auto                             size = InputImageType::SizeType::Filled(64);
  const InputImageType::RegionType region(size);

  image->SetRegions(region);
  image->Allocate();

  using InputIteratorType = itk::ImageRegionIteratorWithIndex<InputImageType>;
  InputIteratorType iter(image, region);
  iter.GoToBegin();

  while (!iter.IsAtEnd())
  {
    PointType point;
    image->TransformIndexToPhysicalPoint(iter.GetIndex(), point);
    iter.Set(SimpleSignedDistance(point) > 0 ? outsideValue : insideValue);
    ++iter;
  }

  // Set up the filter
  using DistanceMapFilterType = itk::ApproximateSignedDistanceMapImageFilter<InputImageType, OutputImageType>;
  auto signedDistanceMapFilter = DistanceMapFilterType::New();

  ITK_EXERCISE_BASIC_OBJECT_METHODS(
    signedDistanceMapFilter, ApproximateSignedDistanceMapImageFilter, ImageToImageFilter);

  signedDistanceMapFilter->SetInput(image);

  signedDistanceMapFilter->SetInsideValue(insideValue);
  ITK_TEST_SET_GET_VALUE(insideValue, signedDistanceMapFilter->GetInsideValue());

  signedDistanceMapFilter->SetOutsideValue(outsideValue);
  ITK_TEST_SET_GET_VALUE(outsideValue, signedDistanceMapFilter->GetOutsideValue());

  ITK_TRY_EXPECT_NO_EXCEPTION(signedDistanceMapFilter->Update());


  // Write the output image
  using RescaleFilterType = itk::ShiftScaleImageFilter<OutputImageType, WriterImageType>;
  auto rescaler = RescaleFilterType::New();

  rescaler->SetInput(signedDistanceMapFilter->GetOutput());
  rescaler->SetScale(1000);

  ITK_TRY_EXPECT_NO_EXCEPTION(rescaler->Update());


  if (rescaler->GetUnderflowCount() + rescaler->GetOverflowCount() > 0)
  {
    std::cerr << "Test failed!" << std::endl;
    std::cerr << "Under-/overflow when scaling distances before writing distance map to disc: " << std::endl
              << "Underflow: " << rescaler->GetUnderflowCount() << std::endl
              << "Overflow: " << rescaler->GetOverflowCount() << std::endl;
    return EXIT_FAILURE;
  }

  using WriterType = itk::ImageFileWriter<WriterImageType>;
  auto writer = WriterType::New();
  writer->SetInput(rescaler->GetOutput());
  writer->SetFileName(argv[2]);


  ITK_TRY_EXPECT_NO_EXCEPTION(writer->Update());


  OutputPixelType maxDistance = 0;

  using OutputIteratorType = itk::ImageRegionConstIteratorWithIndex<OutputImageType>;
  OutputIteratorType oIt(signedDistanceMapFilter->GetOutput(),
                         signedDistanceMapFilter->GetOutput()->GetLargestPossibleRegion());
  oIt.GoToBegin();

  while (!oIt.IsAtEnd())
  {
    PointType point;
    image->TransformIndexToPhysicalPoint(oIt.GetIndex(), point);
    const OutputPixelType distance = itk::Math::Absolute(oIt.Get() - SimpleSignedDistance(point));
    if (distance > maxDistance)
    {
      maxDistance = distance;
    }
    ++oIt;
  }

  // Regression test
  constexpr OutputPixelType maxAllowedDistance{ 2 };
  if (maxDistance > maxAllowedDistance)
  {
    std::cout << "Test failed!" << std::endl;
    std::cout << "The output image had pixels too far away from the correct distance." << std::endl;
    std::cout << "The maximum error was: " << static_cast<itk::NumericTraits<OutputPixelType>::PrintType>(maxDistance)
              << std::endl;
    std::cout << "The maximum allowed error is: "
              << static_cast<itk::NumericTraits<OutputPixelType>::PrintType>(maxAllowedDistance) << std::endl;
    return EXIT_FAILURE;
  }

  std::cout << "Test passed" << std::endl;
  return EXIT_SUCCESS;
}
