lsCompareChamfer.hpp

Go to the documentation of this file.

#pragma once
 
#include <lsDomain.hpp>
#include <lsExpand.hpp>
#include <lsMesh.hpp>
#include <lsPreCompileMacros.hpp>
#include <lsToSurfaceMesh.hpp>
 
#include <vcKDTree.hpp>
 
#include <cmath>
#include <limits>
 
namespace viennals {
 
using namespace viennacore;

 
template <class T, int D = 2> class CompareChamfer {
  SmartPointer<Domain<T, D>> levelSetTarget = nullptr;
  SmartPointer<Domain<T, D>> levelSetSample = nullptr;
 
  // Results
  T forwardDistance = 0.0;    // Target → Sample
  T backwardDistance = 0.0;   // Sample → Target
  T chamferDistance = 0.0;    // Average of forward and backward
  T rmsChamferDistance = 0.0; // RMS of all nearest-neighbor distances
  T maxDistance = 0.0;        // Maximum nearest-neighbor distance
  unsigned numTargetPoints = 0;
  unsigned numSamplePoints = 0;
 
  // Optional mesh output
  SmartPointer<Mesh<T>> outputMeshTarget = nullptr;
  SmartPointer<Mesh<T>> outputMeshSample = nullptr;
 
  bool checkCompatibility() {
    if (levelSetTarget == nullptr || levelSetSample == nullptr) {
      Logger::getInstance()
          .addWarning("Missing level set in CompareChamfer.")
          .print();
      return false;
    }
 
    // Check if the grids are compatible
    const auto &gridTarget = levelSetTarget->getGrid();
    const auto &gridSample = levelSetSample->getGrid();
 
    if (gridTarget.getGridDelta() != gridSample.getGridDelta()) {
      Logger::getInstance()
          .addWarning("Grid delta mismatch in CompareChamfer. The grid "
                      "deltas of the two level sets must be equal.")
          .print();
      return false;
    }
 
    return true;
  }
 
public:
  CompareChamfer() {
    static_assert(
        D == 2,
        "CompareChamfer is currently only implemented for 2D level sets.");
  }
 
  CompareChamfer(SmartPointer<Domain<T, D>> passedLevelSetTarget,
                 SmartPointer<Domain<T, D>> passedLevelSetSample)
      : levelSetTarget(passedLevelSetTarget),
        levelSetSample(passedLevelSetSample) {
    static_assert(
        D == 2,
        "CompareChamfer is currently only implemented for 2D level sets.");
  }

  void setLevelSetTarget(SmartPointer<Domain<T, D>> passedLevelSet) {
    levelSetTarget = passedLevelSet;
  }

  void setLevelSetSample(SmartPointer<Domain<T, D>> passedLevelSet) {
    levelSetSample = passedLevelSet;
  }

  void setOutputMeshTarget(SmartPointer<Mesh<T>> passedMesh) {
    outputMeshTarget = passedMesh;
  }

  void setOutputMeshSample(SmartPointer<Mesh<T>> passedMesh) {
    outputMeshSample = passedMesh;
  }

  void apply() {
    // Check compatibility
    if (!checkCompatibility()) {
      // Set NaN results to indicate failure
      forwardDistance = std::numeric_limits<T>::quiet_NaN();
      backwardDistance = std::numeric_limits<T>::quiet_NaN();
      chamferDistance = std::numeric_limits<T>::quiet_NaN();
      rmsChamferDistance = std::numeric_limits<T>::quiet_NaN();
      maxDistance = std::numeric_limits<T>::quiet_NaN();
      numTargetPoints = 0;
      numSamplePoints = 0;
      return;
    }
 
    // Ensure both level sets have sufficient width for surface extraction
    constexpr int minimumWidth = 2;
 
    auto workingTarget = levelSetTarget;
    auto workingSample = levelSetSample;
 
    if (levelSetTarget->getLevelSetWidth() < minimumWidth) {
      workingTarget = SmartPointer<Domain<T, D>>::New(levelSetTarget);
      Expand<T, D>(workingTarget, minimumWidth).apply();
      Logger::getInstance()
          .addInfo("CompareChamfer: Expanded target level set to width " +
                   std::to_string(minimumWidth) + " for surface extraction.")
          .print();
    }
 
    if (levelSetSample->getLevelSetWidth() < minimumWidth) {
      workingSample = SmartPointer<Domain<T, D>>::New(levelSetSample);
      Expand<T, D>(workingSample, minimumWidth).apply();
      Logger::getInstance()
          .addInfo("CompareChamfer: Expanded sample level set to width " +
                   std::to_string(minimumWidth) + " for surface extraction.")
          .print();
    }
 
    // Extract surface meshes
    auto targetSurfaceMesh = SmartPointer<Mesh<T>>::New();
    auto sampleSurfaceMesh = SmartPointer<Mesh<T>>::New();
 
    ToSurfaceMesh<T, D>(workingTarget, targetSurfaceMesh).apply();
    ToSurfaceMesh<T, D>(workingSample, sampleSurfaceMesh).apply();
 
    // Get surface points
    const auto &targetNodes = targetSurfaceMesh->getNodes();
    const auto &sampleNodes = sampleSurfaceMesh->getNodes();
 
    numTargetPoints = targetNodes.size();
    numSamplePoints = sampleNodes.size();
 
    if (numTargetPoints == 0 || numSamplePoints == 0) {
      Logger::getInstance()
          .addWarning(
              "CompareChamfer: One or both surfaces have no points. Cannot "
              "compute Chamfer distance.")
          .print();
      forwardDistance = std::numeric_limits<T>::infinity();
      backwardDistance = std::numeric_limits<T>::infinity();
      chamferDistance = std::numeric_limits<T>::infinity();
      rmsChamferDistance = std::numeric_limits<T>::infinity();
      maxDistance = std::numeric_limits<T>::infinity();
      return;
    }
 
    // Convert nodes to format suitable for KDTree (only using x, y
    // coordinates)
    std::vector<std::array<T, D>> targetPoints(numTargetPoints);
    std::vector<std::array<T, D>> samplePoints(numSamplePoints);
 
    for (unsigned i = 0; i < numTargetPoints; ++i) {
      for (unsigned d = 0; d < D; ++d) {
        targetPoints[i][d] = targetNodes[i][d];
      }
    }
 
    for (unsigned i = 0; i < numSamplePoints; ++i) {
      for (unsigned d = 0; d < D; ++d) {
        samplePoints[i][d] = sampleNodes[i][d];
      }
    }
 
    // Build KD-trees
    KDTree<T, std::array<T, D>> targetTree(targetPoints);
    targetTree.build();
 
    KDTree<T, std::array<T, D>> sampleTree(samplePoints);
    sampleTree.build();
 
    // Compute forward distance (target → sample)
    T sumForward = 0.0;
    T sumSquaredForward = 0.0;
    T maxForward = 0.0;
    std::vector<T> targetDistances;
    if (outputMeshTarget != nullptr) {
      targetDistances.reserve(numTargetPoints);
    }
 
    for (unsigned i = 0; i < numTargetPoints; ++i) {
      auto nearest = sampleTree.findNearest(targetPoints[i]);
      if (nearest.has_value()) {
        T dist = nearest.value().second;
        sumForward += dist;
        sumSquaredForward += dist * dist;
        maxForward = std::max(maxForward, dist);
        if (outputMeshTarget != nullptr) {
          targetDistances.push_back(dist);
        }
      }
    }
 
    forwardDistance = sumForward / numTargetPoints;
 
    // Compute backward distance (sample → target)
    T sumBackward = 0.0;
    T sumSquaredBackward = 0.0;
    T maxBackward = 0.0;
    std::vector<T> sampleDistances;
    if (outputMeshSample != nullptr) {
      sampleDistances.reserve(numSamplePoints);
    }
 
    for (unsigned i = 0; i < numSamplePoints; ++i) {
      auto nearest = targetTree.findNearest(samplePoints[i]);
      if (nearest.has_value()) {
        T dist = nearest.value().second;
        sumBackward += dist;
        sumSquaredBackward += dist * dist;
        maxBackward = std::max(maxBackward, dist);
        if (outputMeshSample != nullptr) {
          sampleDistances.push_back(dist);
        }
      }
    }
 
    backwardDistance = sumBackward / numSamplePoints;
 
    // Compute overall metrics
    chamferDistance =
        (sumForward + sumBackward) / (numTargetPoints + numSamplePoints);
    rmsChamferDistance = std::sqrt((sumSquaredForward + sumSquaredBackward) /
                                   (numTargetPoints + numSamplePoints));
    maxDistance = std::max(maxForward, maxBackward);
 
    // Generate output meshes if requested
    if (outputMeshTarget != nullptr && !targetDistances.empty()) {
      outputMeshTarget->clear();
      outputMeshTarget->nodes = targetNodes;
 
      // Create vertices for visualization
      outputMeshTarget->vertices.reserve(numTargetPoints);
      for (unsigned i = 0; i < numTargetPoints; ++i) {
        outputMeshTarget->vertices.push_back({i});
      }
 
      // Add distance data
      outputMeshTarget->pointData.insertNextScalarData(
          std::move(targetDistances), "DistanceToSample");
 
      // Set mesh extent
      for (unsigned d = 0; d < D; ++d) {
        outputMeshTarget->minimumExtent[d] = std::numeric_limits<T>::max();
        outputMeshTarget->maximumExtent[d] = std::numeric_limits<T>::lowest();
        for (const auto &node : targetNodes) {
          outputMeshTarget->minimumExtent[d] =
              std::min(outputMeshTarget->minimumExtent[d], node[d]);
          outputMeshTarget->maximumExtent[d] =
              std::max(outputMeshTarget->maximumExtent[d], node[d]);
        }
      }
    }
 
    if (outputMeshSample != nullptr && !sampleDistances.empty()) {
      outputMeshSample->clear();
      outputMeshSample->nodes = sampleNodes;
 
      // Create vertices for visualization
      outputMeshSample->vertices.reserve(numSamplePoints);
      for (unsigned i = 0; i < numSamplePoints; ++i) {
        outputMeshSample->vertices.push_back({i});
      }
 
      // Add distance data
      outputMeshSample->pointData.insertNextScalarData(
          std::move(sampleDistances), "DistanceToTarget");
 
      // Set mesh extent
      for (unsigned d = 0; d < D; ++d) {
        outputMeshSample->minimumExtent[d] = std::numeric_limits<T>::max();
        outputMeshSample->maximumExtent[d] = std::numeric_limits<T>::lowest();
        for (const auto &node : sampleNodes) {
          outputMeshSample->minimumExtent[d] =
              std::min(outputMeshSample->minimumExtent[d], node[d]);
          outputMeshSample->maximumExtent[d] =
              std::max(outputMeshSample->maximumExtent[d], node[d]);
        }
      }
    }
  }

  T getForwardDistance() const { return forwardDistance; }

  T getBackwardDistance() const { return backwardDistance; }

  T getChamferDistance() const { return chamferDistance; }

  T getRMSChamferDistance() const { return rmsChamferDistance; }

  T getMaxDistance() const { return maxDistance; }

  unsigned getNumTargetPoints() const { return numTargetPoints; }

  unsigned getNumSamplePoints() const { return numSamplePoints; }
};
 
// Add template specializations for this class
PRECOMPILE_PRECISION_DIMENSION(CompareChamfer)
 
} // namespace viennals