InterestOperator.cpp

#include "Chip.h"
#include "Pvl.h"
#include "InterestOperator.h"
#include "Plugin.h"
#include "IException.h"
#include "FileName.h"
#include "Statistics.h"
#include "PolygonTools.h"
#include "SpecialPixel.h"
#include "ControlNet.h"
#include "ControlPoint.h"
#include "ControlMeasure.h"
#include "ImageOverlapSet.h"
#include "ImagePolygon.h"
#include "MeasureValidationResults.h"
#include "PolygonTools.h"

namespace Isis {

  InterestOperator::InterestOperator(Pvl &pPvl): ControlNetValidMeasure(pPvl) {
    InitInterestOptions();
    mOperatorGrp = PvlGroup("InterestOptions");
    Parse(pPvl);
  }

  void InterestOperator::InitInterestOptions() {
    p_interestAmount = 0.0;
    p_worstInterest = 0.0;
    p_lines = 1;
    p_samples = 1;
    p_deltaSamp = 0;
    p_deltaLine = 0;
    p_clipPolygon = NULL;
    mbOverlaps = false;
  }

  InterestOperator::~InterestOperator() {
    if (p_clipPolygon != NULL) {
      delete p_clipPolygon;
      p_clipPolygon = NULL;
    }
  }

  void InterestOperator::Parse(Pvl &pPvl) {
    try {
      // Get info from the operator group
      // Required Parameters
      PvlGroup &op = pPvl.findGroup("Operator", Pvl::Traverse);

      mOperatorGrp += Isis::PvlKeyword(op["Name"]);

      p_samples   = op["Samples"];
      mOperatorGrp += Isis::PvlKeyword("Samples", toString(p_samples));

      p_lines     = op["Lines"];
      mOperatorGrp += Isis::PvlKeyword("Lines", toString(p_lines));

      p_deltaLine = op["DeltaLine"];
      mOperatorGrp += Isis::PvlKeyword("DeltaLine", toString(p_deltaLine));

      p_deltaSamp = op["DeltaSamp"];
      mOperatorGrp += Isis::PvlKeyword("DeltaSamp", toString(p_deltaSamp));

      p_minimumInterest = op["MinimumInterest"];
      mOperatorGrp += Isis::PvlKeyword("MinimumInterest", toString(p_minimumInterest));

    }
    catch (IException &e) {
      QString msg = "Improper format for InterestOperator PVL [" + pPvl.fileName() + "]";
      throw IException(IException::User, msg, _FILEINFO_);
    }
  }

  void InterestOperator::InitInterestResults(int piIndex) {
    mtInterestResults[piIndex].msSerialNum  = "";
    mtInterestResults[piIndex].mdInterest   = Isis::Null;
    mtInterestResults[piIndex].mdBestSample = Isis::Null;
    mtInterestResults[piIndex].mdBestLine   = Isis::Null;
    mtInterestResults[piIndex].mdOrigSample = Isis::Null;
    mtInterestResults[piIndex].mdOrigLine   = Isis::Null;
    mtInterestResults[piIndex].mdEmission   = 135;
    mtInterestResults[piIndex].mdIncidence  = 135;
    mtInterestResults[piIndex].mdDn         = Isis::ValidMinimum;
    mtInterestResults[piIndex].mdResolution = DBL_MAX ;
    mtInterestResults[piIndex].miDeltaSample = 0;
    mtInterestResults[piIndex].miDeltaLine  = 0;
    mtInterestResults[piIndex].mbValid      = false;
  }

  bool InterestOperator::Operate(Cube &pCube, UniversalGroundMap &pUnivGrndMap,
                                 int piSample, int piLine) {

    if (!pUnivGrndMap.HasCamera())
      // Level 3 images/mosaic or bad image
    {
      QString msg = "Cannot run interest on images with no camera. Image " +
                        pCube.fileName() + " has no Camera";
      throw IException(IException::Programmer, msg, _FILEINFO_);
    }

    int pad = Padding();
    Chip chip(2 * p_deltaSamp + p_samples + pad, 2 * p_deltaLine + p_lines + pad);
    chip.TackCube(piSample, piLine);
    if (p_clipPolygon != NULL)
      chip.SetClipPolygon(*p_clipPolygon);
    chip.Load(pCube);

    // Walk the search chip and find the best interest
    int iBestSamp = 0;
    int iBestLine = 0;
    double dSmallestDist = DBL_MAX;
    double dBestInterest = Isis::Null;
    int iLines   =  2 * p_deltaLine + p_lines / 2 + 1;
    int iSamples =  2 * p_deltaSamp + p_samples / 2 + 1;
    bool bCalculateInterest = false;

    for (int lin = p_lines / 2 + 1; lin <= iLines; lin++) {
      for (int samp = p_samples / 2 + 1; samp <= iSamples; samp++) {
        // Cannot take dnValues from the chip as it contains the interpolated dnValue
        // hence get the dn values directly from the cube
        chip.SetChipPosition((double)samp, (double)lin);

        bCalculateInterest = false;
        MeasureValidationResults results =
          ValidStandardOptions(chip.CubeSample(), chip.CubeLine(), &pCube);
        if (results.isValid()) {
          bCalculateInterest = true;
        }

        if (bCalculateInterest) {
          Chip subChip = chip.Extract(p_samples + pad, p_lines + pad, samp, lin);
          double interest = Interest(subChip);
          if (interest != Isis::Null) {
            if ((dBestInterest == Isis::Null) || CompareInterests(interest, dBestInterest)) {
              double dist = std::sqrt(std::pow(piSample - samp, 2.0) + std::pow(piLine - lin, 2.0));
              if (interest == dBestInterest && dist > dSmallestDist) {
                continue;
              }
              else {
                dBestInterest = interest;
                iBestSamp = samp;
                iBestLine = lin;
                dSmallestDist = dist;
              }
            }
          }
        }
      }
    }

    // Check to see if we went through the interest chip and never got a interest at
    // any location.
    if (dBestInterest == Isis::Null || dBestInterest < p_minimumInterest) {
      if (pUnivGrndMap.SetImage(piSample, piLine)) {
        p_interestAmount = dBestInterest;
      }
      return false;
    }

    p_interestAmount = dBestInterest;
    chip.SetChipPosition(iBestSamp, iBestLine);
    p_cubeSample = chip.CubeSample();
    p_cubeLine   = chip.CubeLine();

    return true;
  }

  void InterestOperator::Operate(ControlNet &pNewNet, QString psSerialNumFile,
                                 QString psOverlapListFile) {
    ReadSerialNumbers(psSerialNumFile);

    // Find all the overlaps between the images in the FROMLIST
    // The overlap polygon coordinates are in Lon/Lat order
    if (psOverlapListFile != "") {
      mOverlaps.ReadImageOverlaps(psOverlapListFile);
      mbOverlaps = true;
    }

    // Process the entire control net by calculating interest and moving the
    // point to a more interesting area
    FindCnetRef(pNewNet);
  }

  void InterestOperator::ProcessLocked_Point_Reference(
    ControlPoint &pCPoint, PvlObject &pPvlObj, int &piMeasuresModified) {
    int iNumMeasures  = pCPoint.GetNumMeasures();
    bool bPntEditLock = pCPoint.IsEditLocked();
    int iMsrIgnored   = 0;

    // Log Point Details
    if (bPntEditLock) {
      pPvlObj += Isis::PvlKeyword("Reference", "No Change, PointEditLock");
    }

    for (int measure = 0; measure < iNumMeasures; measure++) {
      ControlMeasure *newMeasure = new ControlMeasure(*pCPoint[measure]);
      newMeasure->SetDateTime();
      newMeasure->SetChooserName("Application cnetref(interest)");
      bool bMeasureLocked = newMeasure->IsEditLocked();

      QString sn = newMeasure->GetCubeSerialNumber();
      //double dSample = newMeasure->GetSample();
      //double dLine   = newMeasure->GetLine();

      // Log
      PvlGroup pvlMeasureGrp("MeasureDetails");
      pvlMeasureGrp += Isis::PvlKeyword("SerialNum", sn);
      pvlMeasureGrp += Isis::PvlKeyword("OriginalLocation",
                   LocationString(newMeasure->GetSample(), newMeasure->GetLine()));

      if (bMeasureLocked) {
        pvlMeasureGrp += Isis::PvlKeyword("EditLock", "True");
      }

      if (!newMeasure->IsIgnored()) {
        Cube *measureCube = mCubeMgr.OpenCube(mSerialNumbers.FileName(sn));

        MeasureValidationResults results =
          ValidStandardOptions(newMeasure, measureCube);
        if (!results.isValid()) {
          if (bPntEditLock) {
            pvlMeasureGrp += Isis::PvlKeyword("UnIgnored", "Failed Validation Test but not "
                                              "Ignored as Point EditLock is True");
          }
          else if (bMeasureLocked == measure) {
            pvlMeasureGrp += Isis::PvlKeyword("Error", "Failed the Validation Test "
                                              "but is Locked");
          }
          else {
            pvlMeasureGrp += Isis::PvlKeyword("Ignored", "Failed Emission, Incidence, Resolution "
                                              "and/or Dn Value Test");
            newMeasure->SetIgnored(true);
            iMsrIgnored++;
            piMeasuresModified++;
          }
        }
      }
      else {
        pvlMeasureGrp += Isis::PvlKeyword("Ignored", "Originally Ignored");
        iMsrIgnored++;
      }

      pPvlObj += pvlMeasureGrp;
    }

    if ((iNumMeasures - iMsrIgnored) < 2) {
      if (bPntEditLock) {
        pPvlObj += Isis::PvlKeyword("UnIgnored", "Good Measures less than 2 "
                                    "but Point EditLock is True");
      }
      else {
        pCPoint.SetIgnored(true);
        pPvlObj += Isis::PvlKeyword("Ignored", "Good Measures less than 2");
      }
    }
  }

  void InterestOperator::FindCnetRef(ControlNet &pNewNet) {
    int iPointsModified = 0;
    int iMeasuresModified = 0;
    int iRefChanged = 0;

    // Status Report
    mStatus.SetText("Choosing Reference by Interest...");
    mStatus.SetMaximumSteps(pNewNet.GetNumPoints());
    mStatus.CheckStatus();

    // Process each existing control point in the network
    for (int point = 0; point < pNewNet.GetNumPoints(); ++point) {
      ControlPoint *newPnt = pNewNet.GetPoint(point);

      // Create a copy of original control point
      const ControlPoint origPnt(*newPnt);

      // Logging
      PvlObject pvlPointObj("PointDetails");
      pvlPointObj += Isis::PvlKeyword("PointId", newPnt->GetId());

      // Get number of measures locked and check if Reference
      // Measure is locked
      int iNumMeasuresLocked = newPnt->GetNumLockedMeasures();
      int numMeasures = newPnt->GetNumMeasures();

      bool bRefLocked = false;
      int iOrigRefIndex = -1;
      try {
        iOrigRefIndex = newPnt->IndexOfRefMeasure();
        bRefLocked = newPnt->GetRefMeasure()->IsEditLocked();
      }
      catch(IException &) {
      }

      // Only perform the interest operation on points of type "Free" and
      // Points having atleast 1 measure and Point is not Ignored
      if (!newPnt->IsIgnored() && newPnt->GetType() == ControlPoint::Free && numMeasures > 0 &&
          (iNumMeasuresLocked == 0 || (iNumMeasuresLocked > 0 && bRefLocked))) {

        // Check only the validity of the Point / Measures only if Point and/or
        // Reference Measure is locked.
        if (newPnt->IsEditLocked() || iNumMeasuresLocked > 0) {
          ProcessLocked_Point_Reference(*newPnt, pvlPointObj, iMeasuresModified);

          mPvlLog += pvlPointObj;
          mStatus.CheckStatus();

          if (*newPnt != origPnt) {
            iPointsModified ++;
          }
          continue;
        }

        int iBestMeasureIndex = InterestByPoint(*newPnt);

        // Process for point with good interest and a best index
        double dReferenceLat = 0, dReferenceLon = 0;
        if (iBestMeasureIndex >= 0) {
          QString sn = mtInterestResults[iBestMeasureIndex].msSerialNum;
          Cube *bestCube = mCubeMgr.OpenCube(mSerialNumbers.FileName(sn));

          // Get the Camera for the reference image and get the lat/lon from that measurment
          Camera *bestCamera;
          try {
            bestCamera = bestCube->camera();
          }
          catch (IException &e) {
            QString msg = "Cannot Create Camera for Image:" + mSerialNumbers.FileName(sn);
            throw IException(IException::User, msg, _FILEINFO_);
          }

          double dBestSample   = mtInterestResults[iBestMeasureIndex].mdBestSample;
          double dBestLine     = mtInterestResults[iBestMeasureIndex].mdBestLine;

          bestCamera->SetImage(dBestSample, dBestLine);
          dReferenceLat = bestCamera->UniversalLatitude();
          dReferenceLon = bestCamera->UniversalLongitude();

          // Set the point reference
          newPnt->SetRefMeasure(iBestMeasureIndex);
        }

        // Create a measurment for each image in this point using
        // the reference lat/lon.
        int iNumIgnore = 0;
        for (int measure = 0; measure < numMeasures; ++measure) {
          ControlMeasure *newMeasure = newPnt->GetMeasure(measure);
          newMeasure->SetDateTime();
          newMeasure->SetChooserName("Application cnetref(interest)");
          QString sn = newMeasure->GetCubeSerialNumber();

          // Log
          PvlGroup pvlMeasureGrp("MeasureDetails");
          pvlMeasureGrp += Isis::PvlKeyword("SerialNum", sn);
          pvlMeasureGrp += Isis::PvlKeyword("OriginalLocation", LocationString(newMeasure->GetSample(),
                                            newMeasure->GetLine()));

          // Initialize the UGM of this cube with the reference lat/lon
          if (!newMeasure->IsIgnored() && iBestMeasureIndex >= 0 &&
              mtInterestResults[iBestMeasureIndex].mdInterest != WorstInterest()) {
            Cube *measureCube =  mCubeMgr.OpenCube(mSerialNumbers.FileName(sn));

            // default setting
            newMeasure->SetIgnored(false);
            newMeasure->SetType(ControlMeasure::Candidate);

            // Get the Camera
            Camera *measureCamera;
            try {
              measureCamera = measureCube->camera();
            }
            catch (IException &e) {
              QString msg = "Cannot Create Camera for Image:" + mSerialNumbers.FileName(sn);
              throw IException(e, IException::User, msg, _FILEINFO_);
            }

            if (measureCamera->SetUniversalGround(dReferenceLat, dReferenceLon) &&
                measureCamera->InCube()) {
              // Check for reference, Put the corresponding line/samp into a newMeasure
              if (measure == iBestMeasureIndex) {
                newMeasure->SetCoordinate(mtInterestResults[measure].mdBestSample,
                                          mtInterestResults[measure].mdBestLine, ControlMeasure::Candidate);
            //    newMeasure->SetType(ControlMeasure::Reference);



                pvlMeasureGrp += Isis::PvlKeyword("NewLocation",  LocationString(mtInterestResults[measure].mdBestSample,
                                                  mtInterestResults[measure].mdBestLine));
                pvlMeasureGrp += Isis::PvlKeyword("DeltaSample",  toString(mtInterestResults[measure].miDeltaSample));
                pvlMeasureGrp += Isis::PvlKeyword("DeltaLine",    toString(mtInterestResults[measure].miDeltaLine));
                pvlMeasureGrp += Isis::PvlKeyword("Reference",    "true");
              }
              else {
                double dSample = measureCamera->Sample();
                double dLine   = measureCamera->Line();

                double origSample = newMeasure->GetSample();
                double origLine   = newMeasure->GetLine();

                newMeasure->SetCoordinate(dSample, dLine);

                MeasureValidationResults results =
                  ValidStandardOptions(newMeasure, measureCube);
                if (!results.isValid()) {
                  iNumIgnore++;
                  pvlMeasureGrp += Isis::PvlKeyword("Ignored",   "Failed Validation Test-" + results.toString());
                  newMeasure->SetIgnored(true);
                }
                pvlMeasureGrp += Isis::PvlKeyword("NewLocation", LocationString(dSample, dLine));
                pvlMeasureGrp += Isis::PvlKeyword("DeltaSample", toString((int)abs((int)dSample - (int)origSample)));
                pvlMeasureGrp += Isis::PvlKeyword("DeltaLine", toString((int)abs((int)dLine - (int)origLine)));
                pvlMeasureGrp += Isis::PvlKeyword("Reference",   "false");
              }
            }
            else {
              iNumIgnore++;
              pvlMeasureGrp += Isis::PvlKeyword("Ignored", "True");
              newMeasure->SetIgnored(true);
              if (!measureCamera->InCube()) {
                pvlMeasureGrp += Isis::PvlKeyword("Comments", "New location is not in the Image");
              }
            }
          }
          // No best interest, ignore the measure
          else {
            iNumIgnore++;
            pvlMeasureGrp += Isis::PvlKeyword("Ignored", "True");
            newMeasure->SetIgnored(true);
          }

          if (newMeasure != origPnt[measure]) {
            iMeasuresModified ++;
          }

          pvlMeasureGrp += Isis::PvlKeyword("BestInterest",   toString(mtInterestResults[measure].mdInterest));
          pvlMeasureGrp += Isis::PvlKeyword("EmissionAngle",  toString(mtInterestResults[measure].mdEmission));
          pvlMeasureGrp += Isis::PvlKeyword("IncidenceAngle", toString(mtInterestResults[measure].mdIncidence));
          pvlMeasureGrp += Isis::PvlKeyword("Resolution",     toString(mtInterestResults[measure].mdResolution));
          pvlMeasureGrp += Isis::PvlKeyword("DNValue",        toString(mtInterestResults[measure].mdDn));
          pvlPointObj += pvlMeasureGrp;
        } // Measures Loop

        // Check the ignored measures number
        if ((numMeasures - iNumIgnore) < 2) {
          newPnt->SetIgnored(true);
          pvlPointObj += Isis::PvlKeyword("Ignored", "Good Measures less than 2");
        }

        iNumIgnore = 0;

        if (*newPnt != origPnt) {
          iPointsModified ++;
        }

        if (!newPnt->IsIgnored() && iBestMeasureIndex != iOrigRefIndex) {
          iRefChanged ++;
          PvlGroup pvlRefChangeGrp("ReferenceChangeDetails");
          if (iOrigRefIndex >= 0) {
            pvlRefChangeGrp += Isis::PvlKeyword("PrevSerialNumber", mtInterestResults[iOrigRefIndex].msSerialNum);
            pvlRefChangeGrp += Isis::PvlKeyword("PrevBestInterest", toString(mtInterestResults[iOrigRefIndex].mdInterest));
            pvlRefChangeGrp += Isis::PvlKeyword("PrevLocation",     LocationString(mtInterestResults[iOrigRefIndex].mdOrigSample,
                                                mtInterestResults[iOrigRefIndex].mdOrigLine));
          }
          else {
            pvlRefChangeGrp += Isis::PvlKeyword("PrevReference", "Not Set");
          }
          pvlRefChangeGrp += Isis::PvlKeyword("NewSerialNumber",  mtInterestResults[iBestMeasureIndex].msSerialNum);
          pvlRefChangeGrp += Isis::PvlKeyword("NewBestInterest",  toString(mtInterestResults[iBestMeasureIndex].mdInterest));
          pvlRefChangeGrp += Isis::PvlKeyword("NewLocation",      LocationString(mtInterestResults[iBestMeasureIndex].mdBestSample,
                                              mtInterestResults[iBestMeasureIndex].mdBestLine));

          // Log info, if Point not locked, apriori source == Reference and a new reference
          if (newPnt->GetAprioriSurfacePointSource() == ControlPoint::SurfacePointSource::Reference) {
            pvlRefChangeGrp += Isis::PvlKeyword("AprioriSource", "Reference is the source and has changed");
          }

          pvlPointObj += pvlRefChangeGrp;
        }
        else {
          pvlPointObj += Isis::PvlKeyword("Reference", "No Change");
        }
        // Clean up the results structure
        delete [] mtInterestResults;
      }
      else {
        // Process Ignored, non Free points or Measures=0
        int iComment = 0;

        if (numMeasures == 0) {
          QString sComment = "Comment";
          sComment += toString(++iComment);
          pvlPointObj += Isis::PvlKeyword(sComment, "No Measures in the Point");
        }

        if (newPnt->IsIgnored()) {
          QString sComment = "Comment";
          sComment += toString(++iComment);
          pvlPointObj += Isis::PvlKeyword(sComment, "Point was originally Ignored");
        }

        if (newPnt->GetType() == ControlPoint::Fixed) {
          QString sComment = "Comment";
          sComment += toString(++iComment);
          pvlPointObj += Isis::PvlKeyword(sComment, "Fixed Point");
        }
        else if (newPnt->GetType() == ControlPoint::Constrained) {
          QString sComment = "Comment";
          sComment += toString(++iComment);
          pvlPointObj += Isis::PvlKeyword(sComment, "Constrained Point");
        }

        if (iNumMeasuresLocked > 0 && !bRefLocked) {
          pvlPointObj += Isis::PvlKeyword("Error", "Point has a Measure with EditLock set to true "
                                          "but the Reference is not Locked");
        }
        else {
          for (int measure = 0; measure < newPnt->GetNumMeasures(); measure++) {
            ControlMeasure *cm = newPnt->GetMeasure(measure);
            cm->SetDateTime();
            cm->SetChooserName("Application cnetref(Interest)");
          }
        }
      } // End of if point is of type free

      mPvlLog += pvlPointObj;

      mStatus.CheckStatus();
    } // Point loop

    // CnetRef Change Statistics
    mStatisticsGrp += Isis::PvlKeyword("PointsModified",   toString(iPointsModified));
    mStatisticsGrp += Isis::PvlKeyword("ReferenceChanged", toString(iRefChanged));
    mStatisticsGrp += Isis::PvlKeyword("MeasuresModified", toString(iMeasuresModified));

    mPvlLog += mStatisticsGrp;
  }

  int InterestOperator::InterestByPoint(ControlPoint &pCnetPoint) {
    // Find the overlap this point is inside of if the overlap list is entered
    const geos::geom::MultiPolygon *overlapPoly = NULL;

    if (mbOverlaps) {
      overlapPoly = FindOverlap(pCnetPoint);
      if (overlapPoly == NULL) {
        QString msg = "Unable to find overlap polygon for point [" +
                      pCnetPoint.GetId() + "]";
        throw IException(IException::User, msg, _FILEINFO_);
      }
    }

    std::vector <PvlGroup> pvlGrpVector;

    // Create an array of Interest Results structure of measures size
    mtInterestResults = new InterestResults[pCnetPoint.GetNumMeasures()];

    int iBestMeasureIndex     = -1;
    double dBestInterestValue = Isis::Null;

    for (int measure = 0; measure < pCnetPoint.GetNumMeasures(); ++measure) {
      ControlMeasure *origMsr = pCnetPoint[measure];
      QString sn = origMsr->GetCubeSerialNumber();

      // Do not process Ignored Measures
      try {
        if (!origMsr->IsIgnored()) {
          InitInterestResults(measure);
          Cube *inCube = mCubeMgr.OpenCube(mSerialNumbers.FileName(sn));

          // Set the clipping polygon for this point
          // Convert the lon/lat overlap polygon to samp/line using the UGM for
          // this image
          if (mbOverlaps) {
            UniversalGroundMap unvGround = UniversalGroundMap(*inCube);
            geos::geom::MultiPolygon *poly = PolygonTools::LatLonToSampleLine(*overlapPoly,
                                                                              &unvGround);
            SetClipPolygon(*poly);
            delete poly;
          }

          // Run the interest operator on this measurment
          if (InterestByMeasure(measure, *origMsr, *inCube)) {
            if (dBestInterestValue == Isis::Null ||
                CompareInterests(mtInterestResults[measure].mdInterest, dBestInterestValue)) {
              dBestInterestValue = mtInterestResults[measure].mdInterest;
              iBestMeasureIndex = measure;
            }
          }
        }
      }
      catch (IException &e) {
       // e.print();
      }
    }
    return iBestMeasureIndex;
  }

  bool InterestOperator::InterestByMeasure(int piMeasure, ControlMeasure &pCnetMeasure,
      Cube &pCube) {
    QString serialNum = pCnetMeasure.GetCubeSerialNumber();

    int iOrigSample = (int)(pCnetMeasure.GetSample() + 0.5);
    int iOrigLine   = (int)(pCnetMeasure.GetLine() + 0.5);

    mtInterestResults[piMeasure].msSerialNum    = serialNum;
    mtInterestResults[piMeasure].mdOrigSample   = pCnetMeasure.GetSample();
    mtInterestResults[piMeasure].mdOrigLine     = pCnetMeasure.GetLine();

    int pad = Padding();
    Chip chip(2 * p_deltaSamp + p_samples + pad, 2 * p_deltaLine + p_lines + pad);
    chip.TackCube(iOrigSample, iOrigLine);
    if (p_clipPolygon != NULL)
      chip.SetClipPolygon(*p_clipPolygon);
    chip.Load(pCube);

    // Walk the search chip and find the best interest
    int iBestSamp = 0;
    int iBestLine = 0;
    double dSmallestDist = DBL_MAX;
    double dBestInterest = Isis::Null;
    int iLines   =  2 * p_deltaLine + p_lines / 2 + 1;
    int iSamples =  2 * p_deltaSamp + p_samples / 2 + 1;
    bool bCalculateInterest = false;
    for (int lin = p_lines / 2 + 1; lin <= iLines; lin++) {
      for (int samp = p_samples / 2 + 1; samp <= iSamples; samp++) {
        // Cannot take dnValues from the chip as it contains the interpolated dnValue
        // hence get the dn values directly from the cube
        chip.SetChipPosition((double)samp, (double)lin);

        bCalculateInterest = false;

        MeasureValidationResults results =
          ValidStandardOptions(chip.CubeSample(), chip.CubeLine(), &pCnetMeasure, &pCube);
        if (results.isValid()) {
          bCalculateInterest = true;
        }

        if (bCalculateInterest) {
          Chip subChip = chip.Extract(p_samples + pad, p_lines + pad, samp, lin);
          double interest = Interest(subChip);

          if (interest != Isis::Null) {
            if ((dBestInterest == Isis::Null) || CompareInterests(interest, dBestInterest)) {
              double dist = std::sqrt(std::pow(iOrigSample - samp, 2.0) +
                                      std::pow(iOrigLine - lin, 2.0));
              if (interest == dBestInterest && dist > dSmallestDist) {
                continue;
              }
              else {
                dBestInterest = interest;
                dSmallestDist = dist;
                iBestSamp = samp;
                iBestLine = lin;

                mtInterestResults[piMeasure].mdEmission   = mdEmissionAngle;
                mtInterestResults[piMeasure].mdIncidence  = mdIncidenceAngle;
                mtInterestResults[piMeasure].mdDn         = mdDnValue;
                mtInterestResults[piMeasure].mdResolution = mdResolution ;
                mtInterestResults[piMeasure].mbValid      = true;
              }
            }
          }
        }
      }
    }

    // Check to see if we went through the interest chip and never got a interest at
    // any location.But record the Emission, Incidence Angles and DN Value for the failed
    // Measure at the original location
    if (dBestInterest == Isis::Null || dBestInterest < p_minimumInterest) {
      // Get the Camera
      Camera *camera;
      try {
        camera = pCube.camera();
      }
      catch (IException &e) {
        QString msg = "Cannot Create Camera for Image:" + mSerialNumbers.FileName(serialNum);
        throw IException(IException::User, msg, _FILEINFO_);
      }

      if (camera->SetImage(iOrigSample, iOrigLine)) {
        Portal inPortal(1, 1, pCube.pixelType());
        inPortal.SetPosition(iOrigSample, iOrigLine, 1);
        pCube.read(inPortal);

        mtInterestResults[piMeasure].mdInterest   = dBestInterest;
        mtInterestResults[piMeasure].mdBestSample = Isis::Null;
        mtInterestResults[piMeasure].mdBestLine   = Isis::Null;
        mtInterestResults[piMeasure].mdOrigSample = iOrigSample;
        mtInterestResults[piMeasure].mdOrigLine   = iOrigLine;
        mtInterestResults[piMeasure].mdEmission   = camera->EmissionAngle();
        mtInterestResults[piMeasure].mdIncidence  = camera->IncidenceAngle();
        mtInterestResults[piMeasure].mdDn         = inPortal[0];
        mtInterestResults[piMeasure].mdResolution = camera->PixelResolution();
        mtInterestResults[piMeasure].mbValid      = false;
      }
      return false;
    }

    chip.SetChipPosition(iBestSamp, iBestLine);
    mtInterestResults[piMeasure].mdInterest    = dBestInterest;
    mtInterestResults[piMeasure].mdBestSample  = chip.CubeSample();
    mtInterestResults[piMeasure].mdBestLine    = chip.CubeLine();
    mtInterestResults[piMeasure].miDeltaSample = (int)abs(mtInterestResults[piMeasure].mdBestSample -
        iOrigSample);
    mtInterestResults[piMeasure].miDeltaLine   = (int)abs(mtInterestResults[piMeasure].mdBestLine -
        iOrigLine);
    return true;
  }

  const geos::geom::MultiPolygon *InterestOperator::FindOverlap(ControlPoint &pCnetPoint) {
    int exactMatchIndex = -1;

    for (int overlapIndex = 0; ((exactMatchIndex == -1) && (overlapIndex < mOverlaps.Size()));
         overlapIndex ++) {
      const Isis::ImageOverlap *overlap = mOverlaps[overlapIndex];

      // Exact matches only; skip if # SNs don't match
      if (overlap->Size() != pCnetPoint.GetNumMeasures())
        continue;

      // If # SNs match and each SN is contained in both then we're good, there
      // should never be two measures with the same SN
      int numMatches = 0;

      for (int measureIndex = 0;
           measureIndex < pCnetPoint.GetNumMeasures();
           measureIndex ++) {
        if (measureIndex == numMatches) {
          const ControlMeasure &controlMeasure = *pCnetPoint[measureIndex];
          QString serialNum = controlMeasure.GetCubeSerialNumber();
          if (overlap->HasSerialNumber(serialNum)) {
            numMatches++;
          }
        }
      }

      if (numMatches == pCnetPoint.GetNumMeasures()) {
        exactMatchIndex = overlapIndex;
      }
    }

    if (exactMatchIndex < 0) {
      return (FindOverlapByImageFootPrint(pCnetPoint));
    }

    return mOverlaps[exactMatchIndex]->Polygon();
  }

  const geos::geom::MultiPolygon *InterestOperator::FindOverlapByImageFootPrint
  (Isis::ControlPoint &pCnetPoint) {
    ImagePolygon measPolygon1, measPolygon2, measPolygon3;
    geos::geom::Geometry *geomIntersect1, *geomIntersect2;

    // Create Multipolygon for the first Control Measure
    QString sn1 = pCnetPoint[0]->GetCubeSerialNumber();
    Cube *inCube1 = mCubeMgr.OpenCube(mSerialNumbers.FileName(sn1));
    inCube1->read((Blob &)measPolygon1);

    // Create Multipolygon for the Second Control Measure
    QString sn2 = pCnetPoint[1]->GetCubeSerialNumber();
    Cube *inCube2 = mCubeMgr.OpenCube(mSerialNumbers.FileName(sn2));
    inCube2->read((Blob &)measPolygon2);

    // Get the interesection for the first 2 polgons
    geomIntersect1 = PolygonTools::Intersect((const geos::geom::Geometry *)measPolygon1.Polys(),
                     (const geos::geom::Geometry *)measPolygon2.Polys());

    for (int measureIndex = 2; measureIndex < pCnetPoint.GetNumMeasures(); measureIndex ++) {
      QString sn3 = pCnetPoint[measureIndex]->GetCubeSerialNumber();
      Cube *inCube3 = mCubeMgr.OpenCube(mSerialNumbers.FileName(sn3));
      inCube3->read((Blob &)measPolygon3);

      // Get the intersection of the intersection and the measure Image Polygon
      geomIntersect2 = PolygonTools::Intersect(geomIntersect1,
                       (const geos::geom::Geometry *)measPolygon3.Polys());
      geomIntersect1 = geomIntersect2;
    }
    return PolygonTools::MakeMultiPolygon(geomIntersect1);
  }

  bool InterestOperator::CompareInterests(double int1, double int2) {
    return(int1 >= int2);
  }


  // add this object's group to the pvl
  void InterestOperator::addGroup(Isis::PvlObject &obj) {
    Isis::PvlGroup group;
    obj.addGroup(group);
  }


  void InterestOperator::SetClipPolygon(const geos::geom::MultiPolygon &clipPolygon) {
    if (p_clipPolygon != NULL)
      delete p_clipPolygon;
    p_clipPolygon = PolygonTools::CopyMultiPolygon(clipPolygon);
  }

  int InterestOperator::Padding() {
    return 0;
  }

  PvlGroup InterestOperator::Operator() {
    return mOperatorGrp;
  }
}