
//============================================================================
//  Copyright (c) Kitware, Inc.
//  All rights reserved.
//  See LICENSE.txt 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.
//============================================================================


#ifndef vtk_m_worklet_contour_flyingedges_pass4x_with_norms_h
#define vtk_m_worklet_contour_flyingedges_pass4x_with_norms_h


#include <vtkm/filter/contour/worklet/contour/FlyingEdgesHelpers.h>
#include <vtkm/filter/contour/worklet/contour/FlyingEdgesTables.h>

#include <vtkm/filter/contour/worklet/contour/FlyingEdgesPass4.h>

namespace vtkm
{
namespace worklet
{
namespace flying_edges
{

template <typename T>
struct ComputePass4XWithNormals : public vtkm::worklet::WorkletVisitCellsWithPoints
{

  vtkm::Id3 PointDims;
  T IsoValue;

  vtkm::Id CellWriteOffset;
  vtkm::Id PointWriteOffset;

  ComputePass4XWithNormals() {}
  ComputePass4XWithNormals(T value,
                           const vtkm::Id3& pdims,
                           vtkm::Id multiContourCellOffset,
                           vtkm::Id multiContourPointOffset)
    : PointDims(pdims)
    , IsoValue(value)
    , CellWriteOffset(multiContourCellOffset)
    , PointWriteOffset(multiContourPointOffset)
  {
  }

  using ControlSignature = void(CellSetIn,
                                FieldInPoint axis_sums,
                                FieldInPoint axis_mins,
                                FieldInPoint axis_maxs,
                                WholeArrayIn cell_tri_count,
                                WholeArrayIn edgeData,
                                WholeArrayIn coords,
                                WholeArrayIn data,
                                WholeArrayOut connectivity,
                                WholeArrayOut edgeIds,
                                WholeArrayOut weights,
                                WholeArrayOut inputCellIds,
                                WholeArrayOut points,
                                WholeArrayOut normals);
  using ExecutionSignature =
    void(ThreadIndices, _2, _3, _4, _5, _6, _7, _8, _9, _10, _11, _12, _13, _14, WorkIndex);

  template <typename ThreadIndices,
            typename FieldInPointId3,
            typename FieldInPointId,
            typename WholeTriField,
            typename WholeEdgeField,
            typename WholeCoordsField,
            typename WholeDataField,
            typename WholeConnField,
            typename WholeEdgeIdField,
            typename WholeWeightField,
            typename WholeCellIdField,
            typename WholePointField,
            typename WholeNormalsField>
  VTKM_EXEC void operator()(const ThreadIndices& threadIndices,
                            const FieldInPointId3& axis_sums,
                            const FieldInPointId& axis_mins,
                            const FieldInPointId& axis_maxs,
                            const WholeTriField& cellTriCount,
                            const WholeEdgeField& edges,
                            const WholeCoordsField& coords,
                            const WholeDataField& field,
                            const WholeConnField& conn,
                            const WholeEdgeIdField& interpolatedEdgeIds,
                            const WholeWeightField& weights,
                            const WholeCellIdField& inputCellIds,
                            const WholePointField& points,
                            const WholeNormalsField& normals,
                            vtkm::Id oidx) const
  {
    using AxisToSum = SumXAxis;

    //This works as cellTriCount was computed with ScanExtended
    //and therefore has one more entry than the number of cells
    vtkm::Id cell_tri_offset = cellTriCount.Get(oidx);
    vtkm::Id next_tri_offset = cellTriCount.Get(oidx + 1);
    if (cell_tri_offset == next_tri_offset)
    { //we produce nothing
      return;
    }
    cell_tri_offset += this->CellWriteOffset;

    Pass4TrimState state(
      AxisToSum{}, this->PointDims, threadIndices, axis_sums, axis_mins, axis_maxs, edges);
    if (!state.hasWork)
    {
      return;
    }

    const vtkm::Id3 pdims = this->PointDims;
    const vtkm::Id3 increments = compute_incs3d(pdims);
    vtkm::Id edgeIds[12];

    auto edgeCase = getEdgeCase(edges, state.startPos, (state.axis_inc * state.left));
    init_voxelIds(AxisToSum{}, this->PointWriteOffset, edgeCase, axis_sums, edgeIds);
    for (vtkm::Id i = state.left; i < state.right; ++i) // run along the trimmed voxels
    {
      edgeCase = getEdgeCase(edges, state.startPos, (state.axis_inc * i));
      vtkm::UInt8 numTris = data::GetNumberOfPrimitives(edgeCase);
      if (numTris > 0)
      {
        // Start by generating triangles for this case
        generate_tris<AxisToSum>(
          state.cellId, edgeCase, numTris, edgeIds, cell_tri_offset, conn, inputCellIds);

        // Now generate edgeIds and weights along voxel axes if needed. Remember to take
        // boundary into account.

        auto* edgeUses = data::GetEdgeUses(edgeCase);
        if (!fully_interior(state.boundaryStatus) || case_includes_axes(edgeUses))
        {
          this->Generate(state.boundaryStatus,
                         state.ijk,
                         field,
                         interpolatedEdgeIds,
                         weights,
                         coords,
                         points,
                         normals,
                         state.startPos,
                         increments,
                         (state.axis_inc * i),
                         edgeUses,
                         edgeIds);
        }
        advance_voxelIds(edgeUses, edgeIds);
      }
      state.increment(AxisToSum{}, pdims);
    }
  }

  //----------------------------------------------------------------------------
  template <typename WholeDataField,
            typename WholeIEdgeField,
            typename WholeWeightField,
            typename WholeCoordsField,
            typename WholePointField,
            typename WholeNormalField>
  VTKM_EXEC inline void Generate(const vtkm::Vec<vtkm::UInt8, 3>& boundaryStatus,
                                 const vtkm::Id3& ijk,
                                 const WholeDataField& field,
                                 const WholeIEdgeField& interpolatedEdgeIds,
                                 const WholeWeightField& weights,
                                 const WholeCoordsField coords,
                                 const WholePointField& points,
                                 const WholeNormalField& normals,
                                 const vtkm::Id4& startPos,
                                 const vtkm::Id3& incs,
                                 vtkm::Id offset,
                                 vtkm::UInt8 const* const edgeUses,
                                 vtkm::Id* edgeIds) const
  {
    using AxisToSum = SumXAxis;
    bool fullyInterior = fully_interior(boundaryStatus);

    vtkm::Id2 pos(startPos[0] + offset, 0);
    {
      auto s0 = field.Get(pos[0]);
      auto g0 = this->ComputeGradient(fullyInterior, ijk, incs, pos[0], field);

      //EdgesUses 0,4,8 work for Y axis
      if (edgeUses[0])
      { // edgesUses[0] == i axes edge
        auto writeIndex = edgeIds[0];
        pos[1] = startPos[0] + offset + incs[AxisToSum::xindex];
        auto s1 = field.Get(pos[1]);
        T t = static_cast<T>((this->IsoValue - s0) / (s1 - s0));

        interpolatedEdgeIds.Set(writeIndex, pos);
        weights.Set(writeIndex, static_cast<vtkm::FloatDefault>(t));

        auto ijk1 = ijk + vtkm::Id3{ 1, 0, 0 };
        auto coord = this->InterpolateCoordinate(coords, t, ijk, ijk1);
        points.Set(writeIndex, coord);

        //gradient generation
        auto g1 = this->ComputeGradient(fullyInterior, ijk1, incs, pos[1], field);
        g1 = g0 + (t * (g1 - g0));
        normals.Set(writeIndex, vtkm::Normal(g1));
      }
      if (edgeUses[4])
      { // edgesUses[4] == j axes edge
        auto writeIndex = edgeIds[4];
        pos[1] = startPos[1] + offset;
        auto s1 = field.Get(pos[1]);
        T t = static_cast<T>((this->IsoValue - s0) / (s1 - s0));

        interpolatedEdgeIds.Set(writeIndex, pos);
        weights.Set(writeIndex, static_cast<vtkm::FloatDefault>(t));

        auto ijk1 = ijk + vtkm::Id3{ 0, 1, 0 };
        auto coord = this->InterpolateCoordinate(coords, t, ijk, ijk1);
        points.Set(writeIndex, coord);

        //gradient generation
        auto g1 = this->ComputeGradient(fullyInterior, ijk1, incs, pos[1], field);
        g1 = g0 + (t * (g1 - g0));
        normals.Set(writeIndex, vtkm::Normal(g1));
      }
      if (edgeUses[8])
      { // edgesUses[8] == k axes edge
        auto writeIndex = edgeIds[8];
        pos[1] = startPos[2] + offset;
        auto s1 = field.Get(pos[1]);
        T t = static_cast<T>((this->IsoValue - s0) / (s1 - s0));

        interpolatedEdgeIds.Set(writeIndex, pos);
        weights.Set(writeIndex, static_cast<vtkm::FloatDefault>(t));

        auto ijk1 = ijk + vtkm::Id3{ 0, 0, 1 };
        auto coord = this->InterpolateCoordinate(coords, t, ijk, ijk1);
        points.Set(writeIndex, coord);

        //gradient generation
        auto g1 = this->ComputeGradient(fullyInterior, ijk1, incs, pos[1], field);
        g1 = g0 + (t * (g1 - g0));
        normals.Set(writeIndex, vtkm::Normal(g1));
      }
    }

    // On the boundary cells special work has to be done to cover the partial
    // cell axes. These are boundary situations where the voxel axes is not
    // fully formed. These situations occur on the +x,+y,+z volume
    // boundaries. The other cases such as interior, or -x,-y,-z boundaries fall through
    // which is expected
    //
    // clang-format off
    const bool onX = boundaryStatus[AxisToSum::xindex] & FlyingEdges3D::MaxBoundary;
    const bool onY = boundaryStatus[AxisToSum::yindex] & FlyingEdges3D::MaxBoundary;
    const bool onZ = boundaryStatus[AxisToSum::zindex] & FlyingEdges3D::MaxBoundary;
    if (onX) //+x boundary
    {
      this->InterpolateEdge(
          fullyInterior, ijk, pos[0], incs, 5, edgeUses, edgeIds, field, interpolatedEdgeIds, weights, coords, points, normals);
      this->InterpolateEdge(
          fullyInterior, ijk, pos[0], incs, 9, edgeUses, edgeIds, field, interpolatedEdgeIds, weights, coords, points, normals);
      if (onY) //+x +y
      {
        this->InterpolateEdge(
          fullyInterior, ijk, pos[0], incs, 11, edgeUses, edgeIds, field, interpolatedEdgeIds, weights, coords, points, normals);
      }
      if (onZ) //+x +z
      {
        this->InterpolateEdge(
          fullyInterior, ijk, pos[0], incs, 7, edgeUses, edgeIds, field, interpolatedEdgeIds, weights, coords, points, normals);
      }
    }
    if (onY) //+y boundary
    {
      this->InterpolateEdge(
        fullyInterior, ijk, pos[0], incs, 1, edgeUses, edgeIds, field, interpolatedEdgeIds, weights, coords, points, normals);
      this->InterpolateEdge(
        fullyInterior, ijk, pos[0], incs, 10, edgeUses, edgeIds, field, interpolatedEdgeIds, weights, coords, points, normals);
      if (onZ) //+y +z boundary
      {
        this->InterpolateEdge(
          fullyInterior, ijk, pos[0], incs, 3, edgeUses, edgeIds, field, interpolatedEdgeIds, weights, coords, points, normals);
      }
    }
    if (onZ) //+z boundary
    {
      this->InterpolateEdge(
        fullyInterior, ijk, pos[0], incs, 2, edgeUses, edgeIds, field, interpolatedEdgeIds, weights, coords, points, normals);
      this->InterpolateEdge(
        fullyInterior, ijk, pos[0], incs, 6, edgeUses, edgeIds, field, interpolatedEdgeIds, weights, coords, points, normals);
    }
    // clang-format on
  }

  // Indicate whether voxel axes need processing for this case.
  //----------------------------------------------------------------------------
  template <typename WholeField,
            typename WholeIEdgeField,
            typename WholeWeightField,
            typename WholePointField,
            typename WholeCoordsField,
            typename WholeNormalField>
  VTKM_EXEC inline void InterpolateEdge(bool fullyInterior,
                                        const vtkm::Id3& ijk,
                                        vtkm::Id currentIdx,
                                        const vtkm::Id3& incs,
                                        vtkm::Id edgeNum,
                                        vtkm::UInt8 const* const edgeUses,
                                        vtkm::Id* edgeIds,
                                        const WholeField& field,
                                        const WholeIEdgeField& interpolatedEdgeIds,
                                        const WholeWeightField& weights,
                                        const WholeCoordsField& coords,
                                        const WholePointField& points,
                                        const WholeNormalField& normals) const
  {
    using AxisToSum = SumXAxis;

    // if this edge is not used then get out
    if (!edgeUses[edgeNum])
    {
      return;
    }
    const vtkm::Id writeIndex = edgeIds[edgeNum];

    // build the edge information
    vtkm::Vec<vtkm::UInt8, 2> verts = data::GetVertMap(edgeNum);

    vtkm::Id3 offsets1 = data::GetVertOffsets(AxisToSum{}, verts[0]);
    vtkm::Id3 offsets2 = data::GetVertOffsets(AxisToSum{}, verts[1]);

    vtkm::Id2 iEdge(currentIdx + vtkm::Dot(offsets1, incs), currentIdx + vtkm::Dot(offsets2, incs));

    interpolatedEdgeIds.Set(writeIndex, iEdge);

    auto s0 = field.Get(iEdge[0]);
    auto s1 = field.Get(iEdge[1]);
    T t = static_cast<T>((this->IsoValue - s0) / (s1 - s0));
    weights.Set(writeIndex, static_cast<vtkm::FloatDefault>(t));

    auto coord = this->InterpolateCoordinate(coords, t, ijk + offsets1, ijk + offsets2);
    points.Set(writeIndex, coord);

    auto g1 = this->ComputeGradient(fullyInterior, ijk + offsets2, incs, iEdge[1], field);
    auto g0 = this->ComputeGradient(fullyInterior, ijk + offsets1, incs, iEdge[0], field);
    g1 = g0 + (t * (g1 - g0));
    normals.Set(writeIndex, vtkm::Normal(g1));
  }

  // Fast interpolation method for uniform coordinates
  //----------------------------------------------------------------------------
  inline VTKM_EXEC vtkm::Vec3f InterpolateCoordinate(
    const vtkm::internal::ArrayPortalUniformPointCoordinates& coords,
    T t,
    const vtkm::Id3& ijk0,
    const vtkm::Id3& ijk1) const
  {
    return vtkm::Vec3f(
      coords.GetOrigin()[0] +
        coords.GetSpacing()[0] *
          (static_cast<vtkm::FloatDefault>(ijk0[0]) +
           static_cast<vtkm::FloatDefault>(t) * static_cast<vtkm::FloatDefault>(ijk1[0] - ijk0[0])),
      coords.GetOrigin()[1] +
        coords.GetSpacing()[1] *
          (static_cast<vtkm::FloatDefault>(ijk0[1]) +
           static_cast<vtkm::FloatDefault>(t) * static_cast<vtkm::FloatDefault>(ijk1[1] - ijk0[1])),
      coords.GetOrigin()[2] +
        coords.GetSpacing()[2] *
          (static_cast<vtkm::FloatDefault>(ijk0[2]) +
           static_cast<vtkm::FloatDefault>(t) *
             static_cast<vtkm::FloatDefault>(ijk1[2] - ijk0[2])));
  }

  // Interpolation for explicit coordinates
  //----------------------------------------------------------------------------
  template <typename CoordsPortal>
  inline VTKM_EXEC vtkm::Vec3f InterpolateCoordinate(const CoordsPortal& coords,
                                                     T t,
                                                     const vtkm::Id3& ijk0,
                                                     const vtkm::Id3& ijk1) const
  {
    return (1.0f - static_cast<vtkm::FloatDefault>(t)) *
      coords.Get(ijk0[0] + this->PointDims[0] * ijk0[1] +
                 this->PointDims[0] * this->PointDims[1] * ijk0[2]) +
      static_cast<vtkm::FloatDefault>(t) *
      coords.Get(ijk1[0] + this->PointDims[0] * ijk1[1] +
                 this->PointDims[0] * this->PointDims[1] * ijk1[2]);
  }

  //----------------------------------------------------------------------------
  template <typename WholeDataField>
  VTKM_EXEC vtkm::Vec3f ComputeGradient(bool fullyInterior,
                                        const vtkm::Id3& ijk,
                                        const vtkm::Id3& incs,
                                        vtkm::Id pos,
                                        const WholeDataField& field) const
  {
    if (fullyInterior)
    {
      vtkm::Vec3f g = {
        static_cast<vtkm::FloatDefault>(field.Get(pos + incs[0]) - field.Get(pos - incs[0])) * 0.5f,
        static_cast<vtkm::FloatDefault>(field.Get(pos + incs[1]) - field.Get(pos - incs[1])) * 0.5f,
        static_cast<vtkm::FloatDefault>(field.Get(pos + incs[2]) - field.Get(pos - incs[2])) * 0.5f
      };
      return g;
    }

    //We are on some boundary edge
    auto s = field.Get(pos);
    vtkm::Vec3f g;
    for (int i = 0; i < 3; ++i)
    {
      if (ijk[i] == 0)
      {
        g[i] = static_cast<vtkm::FloatDefault>(field.Get(pos + incs[i]) - s);
      }
      else if (ijk[i] >= (this->PointDims[i] - 1))
      {
        g[i] = static_cast<vtkm::FloatDefault>(s - field.Get(pos - incs[i]));
      }
      else
      {
        g[i] =
          static_cast<vtkm::FloatDefault>(field.Get(pos + incs[i]) - field.Get(pos - incs[i])) *
          0.5f;
      }
    }

    return g;
  }
};
}
}
}
#endif
