/*=========================================================================

  Program:   Visualization Toolkit
  Module:    TestDijkstraGraphGeodesicPath.cxx

  Copyright (c) Ken Martin, Will Schroeder, Bill Lorensen
  All rights reserved.
  See Copyright.txt or http://www.kitware.com/Copyright.htm for details.

     This software is distributed WITHOUT ANY WARRANTY; without even
     the implied warranty of MERCHANTABILITY or FITNESS FOR A PARTICULAR
     PURPOSE.  See the above copyright notice for more information.

=========================================================================*/

#include "vtkSmartPointer.h"

#include "vtkActor.h"
#include "vtkCamera.h"
#include "vtkCellArray.h"
#include "vtkDEMReader.h"
#include "vtkImageData.h"
#include "vtkImageDataGeometryFilter.h"
#include "vtkImageResample.h"
#include "vtkLODActor.h"
#include "vtkLookupTable.h"
#include "vtkPoints.h"
#include "vtkPolyData.h"
#include "vtkPolyDataCollection.h"
#include "vtkPolyDataMapper.h"
#include "vtkPolyDataNormals.h"
#include "vtkProperty.h"
#include "vtkRenderWindow.h"
#include "vtkRenderWindowInteractor.h"
#include "vtkRenderer.h"
#include "vtkTesting.h"
#include "vtkTriangleFilter.h"
#include "vtkWarpScalar.h"

#include "vtkContourWidget.h"
#include "vtkOrientedGlyphContourRepresentation.h"
#include "vtkPolygonalSurfaceContourLineInterpolator.h"
#include "vtkPolygonalSurfacePointPlacer.h"
#include "vtkTestUtilities.h"

static char TestDijkstraGraphGeodesicPathLog[] = "# StreamVersion 1\n"
                                                 "EnterEvent 260 15 0 0 0 0 0 i\n"
                                                 "MouseMoveEvent 186 15 0 0 0 0 0 i\n"
                                                 "MouseMoveEvent 124 15 0 0 0 0 0 i\n"
                                                 "MouseMoveEvent 74 11 0 0 0 0 0 i\n"
                                                 "MouseMoveEvent 30 7 0 0 0 0 0 i\n"
                                                 "LeaveEvent -5 3 0 0 0 0 0 i\n"
                                                 "EnterEvent 7 5 0 0 0 0 0 i\n"
                                                 "MouseMoveEvent 17 15 0 0 0 0 0 i\n"
                                                 "MouseMoveEvent 29 29 0 0 0 0 0 i\n"
                                                 "MouseMoveEvent 37 41 0 0 0 0 0 i\n"
                                                 "MouseMoveEvent 45 59 0 0 0 0 0 i\n"
                                                 "MouseMoveEvent 55 77 0 0 0 0 0 i\n"
                                                 "MouseMoveEvent 63 93 0 0 0 0 0 i\n"
                                                 "MouseMoveEvent 71 111 0 0 0 0 0 i\n"
                                                 "MouseMoveEvent 81 127 0 0 0 0 0 i\n"
                                                 "MouseMoveEvent 87 143 0 0 0 0 0 i\n"
                                                 "MouseMoveEvent 95 157 0 0 0 0 0 i\n"
                                                 "MouseMoveEvent 97 169 0 0 0 0 0 i\n"
                                                 "MouseMoveEvent 99 175 0 0 0 0 0 i\n"
                                                 "MouseMoveEvent 99 183 0 0 0 0 0 i\n"
                                                 "MouseMoveEvent 99 184 0 0 0 0 0 i\n"
                                                 "MouseMoveEvent 98 184 0 0 0 0 0 i\n"
                                                 "MouseMoveEvent 90 184 0 0 0 0 0 i\n"
                                                 "MouseMoveEvent 87 184 0 0 0 0 0 i\n"
                                                 "MouseMoveEvent 79 182 0 0 0 0 0 i\n"
                                                 "MouseMoveEvent 73 180 0 0 0 0 0 i\n"
                                                 "MouseMoveEvent 72 179 0 0 0 0 0 i\n"
                                                 "MouseMoveEvent 71 179 0 0 0 0 0 i\n"
                                                 "MouseMoveEvent 70 179 0 0 0 0 0 i\n"
                                                 "MouseMoveEvent 69 180 0 0 0 0 0 i\n"
                                                 "MouseMoveEvent 68 181 0 0 0 0 0 i\n"
                                                 "MouseMoveEvent 67 182 0 0 0 0 0 i\n"
                                                 "MouseMoveEvent 67 184 0 0 0 0 0 i\n"
                                                 "MouseMoveEvent 66 185 0 0 0 0 0 i\n"
                                                 "MouseMoveEvent 62 189 0 0 0 0 0 i\n"
                                                 "MouseMoveEvent 61 191 0 0 0 0 0 i\n"
                                                 "MouseMoveEvent 60 192 0 0 0 0 0 i\n"
                                                 "MouseMoveEvent 58 193 0 0 0 0 0 i\n"
                                                 "MouseMoveEvent 57 194 0 0 0 0 0 i\n"
                                                 "MouseMoveEvent 56 195 0 0 0 0 0 i\n"
                                                 "MouseMoveEvent 54 196 0 0 0 0 0 i\n"
                                                 "MouseMoveEvent 53 197 0 0 0 0 0 i\n"
                                                 "MouseMoveEvent 47 199 0 0 0 0 0 i\n"
                                                 "MouseMoveEvent 46 200 0 0 0 0 0 i\n"
                                                 "MouseMoveEvent 45 201 0 0 0 0 0 i\n"
                                                 "MouseMoveEvent 43 201 0 0 0 0 0 i\n"
                                                 "MouseMoveEvent 42 202 0 0 0 0 0 i\n"
                                                 "MouseMoveEvent 41 203 0 0 0 0 0 i\n"
                                                 "MouseMoveEvent 40 203 0 0 0 0 0 i\n"
                                                 "MouseMoveEvent 39 204 0 0 0 0 0 i\n"
                                                 "MouseMoveEvent 38 204 0 0 0 0 0 i\n"
                                                 "MouseMoveEvent 37 204 0 0 0 0 0 i\n"
                                                 "LeftButtonPressEvent 37 204 0 0 0 0 0 i\n"
                                                 "RenderEvent 37 204 0 0 0 0 0 i\n"
                                                 "LeftButtonReleaseEvent 37 204 0 0 0 0 0 i\n"
                                                 "MouseMoveEvent 67 198 0 0 0 0 0 i\n"
                                                 "MouseMoveEvent 68 198 0 0 0 0 0 i\n"
                                                 "MouseMoveEvent 69 197 0 0 0 0 0 i\n"
                                                 "MouseMoveEvent 70 197 0 0 0 0 0 i\n"
                                                 "MouseMoveEvent 71 196 0 0 0 0 0 i\n"
                                                 "MouseMoveEvent 72 196 0 0 0 0 0 i\n"
                                                 "MouseMoveEvent 73 196 0 0 0 0 0 i\n"
                                                 "MouseMoveEvent 73 195 0 0 0 0 0 i\n"
                                                 "MouseMoveEvent 74 195 0 0 0 0 0 i\n"
                                                 "MouseMoveEvent 75 195 0 0 0 0 0 i\n"
                                                 "MouseMoveEvent 76 195 0 0 0 0 0 i\n"
                                                 "MouseMoveEvent 77 195 0 0 0 0 0 i\n"
                                                 "LeftButtonPressEvent 77 195 0 0 0 0 0 i\n"
                                                 "RenderEvent 77 195 0 0 0 0 0 i\n"
                                                 "LeftButtonReleaseEvent 77 195 0 0 0 0 0 i\n"
                                                 "MouseMoveEvent 105 159 0 0 0 0 0 i\n"
                                                 "LeftButtonPressEvent 105 159 0 0 0 0 0 i\n"
                                                 "RenderEvent 105 159 0 0 0 0 0 i\n"
                                                 "LeftButtonReleaseEvent 105 159 0 0 0 0 0 i\n"
                                                 "MouseMoveEvent 103 122 0 0 0 0 0 i\n"
                                                 "MouseMoveEvent 103 121 0 0 0 0 0 i\n"
                                                 "MouseMoveEvent 104 120 0 0 0 0 0 i\n"
                                                 "MouseMoveEvent 105 119 0 0 0 0 0 i\n"
                                                 "MouseMoveEvent 106 119 0 0 0 0 0 i\n"
                                                 "MouseMoveEvent 107 119 0 0 0 0 0 i\n"
                                                 "MouseMoveEvent 108 119 0 0 0 0 0 i\n"
                                                 "MouseMoveEvent 108 118 0 0 0 0 0 i\n"
                                                 "MouseMoveEvent 109 118 0 0 0 0 0 i\n"
                                                 "MouseMoveEvent 110 118 0 0 0 0 0 i\n"
                                                 "MouseMoveEvent 111 117 0 0 0 0 0 i\n"
                                                 "MouseMoveEvent 112 117 0 0 0 0 0 i\n"
                                                 "MouseMoveEvent 112 116 0 0 0 0 0 i\n"
                                                 "MouseMoveEvent 113 116 0 0 0 0 0 i\n"
                                                 "MouseMoveEvent 114 116 0 0 0 0 0 i\n"
                                                 "LeftButtonPressEvent 114 116 0 0 0 0 0 i\n"
                                                 "RenderEvent 114 116 0 0 0 0 0 i\n"
                                                 "LeftButtonReleaseEvent 114 116 0 0 0 0 0 i\n"
                                                 "KeyPressEvent 270 115 0 0 113 1 q i\n"
                                                 "CharEvent 270 115 0 0 113 1 q i\n"
                                                 "ExitEvent 270 115 0 0 113 1 q i\n";

int TestDijkstraGraphGeodesicPath(int argc, char* argv[])
{
  if (argc < 2)
  {
    std::cerr << "Demonstrates editing capabilities of a contour widget on polygonal \n"
              << "data. For consistency, this accepts a DEM data as input, (to compare\n"
              << "it with the TerrainPolylineEditor example. However, it converts the DEM\n"
              << "data to a polygonal data before feeding it to the contour widget.\n\n"
              << "Usage args: [height_offset]." << std::endl;
    return EXIT_FAILURE;
  }

  // Read height field.
  char* fname = vtkTestUtilities::ExpandDataFileName(argc, argv, "Data/SainteHelens.dem");

  // Read height field.
  //
  vtkSmartPointer<vtkDEMReader> demReader = vtkSmartPointer<vtkDEMReader>::New();
  demReader->SetFileName(fname);
  delete[] fname;

  vtkSmartPointer<vtkImageResample> resample = vtkSmartPointer<vtkImageResample>::New();
  resample->SetInputConnection(demReader->GetOutputPort());
  resample->SetDimensionality(2);
  resample->SetAxisMagnificationFactor(0, 1.0);
  resample->SetAxisMagnificationFactor(1, 1.0);

  // Extract geometry
  vtkSmartPointer<vtkImageDataGeometryFilter> surface =
    vtkSmartPointer<vtkImageDataGeometryFilter>::New();
  surface->SetInputConnection(resample->GetOutputPort());

  // The Dijkistra interpolator will not accept cells that aren't triangles
  vtkSmartPointer<vtkTriangleFilter> triangleFilter = vtkSmartPointer<vtkTriangleFilter>::New();
  triangleFilter->SetInputConnection(surface->GetOutputPort());
  triangleFilter->Update();

  vtkSmartPointer<vtkWarpScalar> warp = vtkSmartPointer<vtkWarpScalar>::New();
  warp->SetInputConnection(triangleFilter->GetOutputPort());
  warp->SetScaleFactor(1);
  warp->UseNormalOn();
  warp->SetNormal(0, 0, 1);

  warp->Update();

  // Define a LUT mapping for the height field

  double lo = demReader->GetOutput()->GetScalarRange()[0];
  double hi = demReader->GetOutput()->GetScalarRange()[1];

  vtkSmartPointer<vtkLookupTable> lut = vtkSmartPointer<vtkLookupTable>::New();
  lut->SetHueRange(0.6, 0);
  lut->SetSaturationRange(1.0, 0);
  lut->SetValueRange(0.5, 1.0);

  vtkSmartPointer<vtkPolyDataNormals> normals = vtkSmartPointer<vtkPolyDataNormals>::New();

  bool distanceOffsetSpecified = false;
  double distanceOffset = 0.0;
  for (int i = 0; i < argc - 1; i++)
  {
    if (strcmp("-DistanceOffset", argv[i]) == 0)
    {
      distanceOffset = atof(argv[i + 1]);
      distanceOffsetSpecified = true;
    }
  }

  if (distanceOffsetSpecified)
  {
    normals->SetInputConnection(warp->GetOutputPort());
    normals->SetFeatureAngle(60);
    normals->SplittingOff();

    // vtkPolygonalSurfacePointPlacer needs cell normals
    // vtkPolygonalSurfaceContourLineInterpolator needs vertex normals
    normals->ComputeCellNormalsOn();
    normals->ComputePointNormalsOn();
    normals->Update();
  }

  vtkPolyData* pd = (distanceOffsetSpecified) ? normals->GetOutput() : warp->GetPolyDataOutput();

  vtkSmartPointer<vtkPolyDataMapper> demMapper = vtkSmartPointer<vtkPolyDataMapper>::New();
  demMapper->SetInputData(pd);
  demMapper->SetScalarRange(lo, hi);
  demMapper->SetLookupTable(lut);

  vtkSmartPointer<vtkActor> demActor = vtkSmartPointer<vtkActor>::New();
  demActor->SetMapper(demMapper);

  // Create the RenderWindow, Renderer and the DEM + path actors.

  vtkSmartPointer<vtkRenderer> ren1 = vtkSmartPointer<vtkRenderer>::New();
  vtkSmartPointer<vtkRenderWindow> renWin = vtkSmartPointer<vtkRenderWindow>::New();
  renWin->AddRenderer(ren1);
  vtkSmartPointer<vtkRenderWindowInteractor> iren =
    vtkSmartPointer<vtkRenderWindowInteractor>::New();
  iren->SetRenderWindow(renWin);

  // Add the actors to the renderer, set the background and size

  ren1->AddActor(demActor);

  ren1->GetActiveCamera()->SetViewUp(0, 0, 1);
  ren1->GetActiveCamera()->SetPosition(-99900, -21354, 131801);
  ren1->GetActiveCamera()->SetFocalPoint(41461, 41461, 2815);
  ren1->ResetCamera();
  ren1->GetActiveCamera()->Dolly(4.2);
  ren1->ResetCameraClippingRange();

  // Here comes the contour widget stuff.....

  vtkSmartPointer<vtkContourWidget> contourWidget = vtkSmartPointer<vtkContourWidget>::New();
  contourWidget->SetInteractor(iren);
  vtkOrientedGlyphContourRepresentation* rep =
    vtkOrientedGlyphContourRepresentation::SafeDownCast(contourWidget->GetRepresentation());
  rep->GetLinesProperty()->SetColor(1, 0.2, 0);
  rep->GetLinesProperty()->SetLineWidth(3.0);

  vtkSmartPointer<vtkPolygonalSurfacePointPlacer> pointPlacer =
    vtkSmartPointer<vtkPolygonalSurfacePointPlacer>::New();
  pointPlacer->AddProp(demActor);
  pointPlacer->GetPolys()->AddItem(pd);
  pointPlacer->SnapToClosestPointOn();
  rep->SetPointPlacer(pointPlacer);

  vtkSmartPointer<vtkPolygonalSurfaceContourLineInterpolator> interpolator =
    vtkSmartPointer<vtkPolygonalSurfaceContourLineInterpolator>::New();
  interpolator->GetPolys()->AddItem(pd);
  rep->SetLineInterpolator(interpolator);
  if (distanceOffsetSpecified)
  {
    pointPlacer->SetDistanceOffset(distanceOffset);
    interpolator->SetDistanceOffset(distanceOffset);
  }

  renWin->Render();
  iren->Initialize();
  contourWidget->EnabledOn();

  return vtkTesting::InteractorEventLoop(argc, argv, iren, TestDijkstraGraphGeodesicPathLog);
}