BundleMeasure.cpp

 
/* SPDX-License-Identifier: CC0-1.0 */
 
#include "BundleMeasure.h"
#include "BundleObservation.h"
#include "BundleObservationSolveSettings.h"
#include "Camera.h"
#include "IException.h"
 
#include "ControlMeasure.h"
 
namespace Isis {
 
  BundleMeasure::BundleMeasure(ControlMeasure *controlMeasure,
                               BundleControlPoint *bundleControlPoint) {
    m_controlMeasure = controlMeasure;
    m_parentControlPoint = bundleControlPoint;
    m_normalsPositionBlockIndex = -1;
    m_normalsPointingBlockIndex = -1;
  }
 
 
  BundleMeasure::~BundleMeasure() {
  }
 
 
  BundleMeasure::BundleMeasure(const BundleMeasure &src) {
    m_controlMeasure = src.m_controlMeasure;
    m_parentControlPoint = src.m_parentControlPoint;
    m_parentBundleImage = src.m_parentBundleImage;
    m_parentObservation = src.m_parentObservation;
    m_normalsPositionBlockIndex = src.m_normalsPositionBlockIndex;
    m_normalsPointingBlockIndex = src.m_normalsPointingBlockIndex;
  }
 
 
  BundleMeasure &BundleMeasure::operator=(const BundleMeasure &src) {
    // Prevent self assignment
    if (this != &src) {
      m_controlMeasure = src.m_controlMeasure;
      m_parentControlPoint = src.m_parentControlPoint;
      m_parentBundleImage = src.m_parentBundleImage;
      m_parentObservation = src.m_parentObservation;
      m_normalsPositionBlockIndex = src.m_normalsPositionBlockIndex;
      m_normalsPointingBlockIndex = src.m_normalsPointingBlockIndex;
    }
 
    return *this;
  }
 
 
  void BundleMeasure::setParentObservation(QSharedPointer<BundleObservation> observation) {
    m_parentObservation = observation;
  }
 
 
  void BundleMeasure::setParentImage(QSharedPointer<BundleImage> image) {
    m_parentBundleImage = image;
  }
 
 
  void BundleMeasure::setRejected(bool reject) {
    m_controlMeasure->SetRejected(reject);
  }
 
 
  void BundleMeasure::setImage() {
    m_controlMeasure->Camera()->SetImage(m_controlMeasure->GetSample(),
                                         m_controlMeasure->GetLine());
  }
 
 
  void BundleMeasure::setNormalsPositionBlockIndex(int index) {
    m_normalsPositionBlockIndex = index;
  }
 
 
  void BundleMeasure::setNormalsPointingBlockIndex(int index) {
    m_normalsPointingBlockIndex = index;
  }
 
 
  int BundleMeasure::positionNormalsBlockIndex() const {
    return m_normalsPositionBlockIndex;
  }
 
 
  int BundleMeasure::pointingNormalsBlockIndex() const {
    return m_normalsPointingBlockIndex;
  }
 
 
  bool BundleMeasure::isRejected() const {
    return m_controlMeasure->IsRejected();
  }
 
 
  Camera *BundleMeasure::camera() const {
    return m_controlMeasure->Camera();
  }
 
 
  BundleControlPoint *BundleMeasure::parentControlPoint() {
    return m_parentControlPoint;
  }
 
 
  QSharedPointer<BundleImage> BundleMeasure::parentBundleImage() {
    return m_parentBundleImage;
  }
 
 
  QSharedPointer<BundleObservation> BundleMeasure::parentBundleObservation() {
    return m_parentObservation;
  }
 
 
  const QSharedPointer<BundleObservationSolveSettings> BundleMeasure::observationSolveSettings() {
    if (!m_parentObservation) {
      QString msg = "In BundleMeasure::observationSolveSettings: "
                    "parent observation has not been set.\n";
      throw IException(IException::Programmer, msg, _FILEINFO_);
    }
    return m_parentObservation->solveSettings();
  }
 
 
  double BundleMeasure::sample() const {
    return m_controlMeasure->GetSample();
  }
 
 
  double BundleMeasure::line() const {
    return m_controlMeasure->GetLine();
  }
 
 
  double BundleMeasure::sampleResidual() const {
    return m_controlMeasure->GetSampleResidual();
  }
 
 
  double BundleMeasure::lineResidual() const {
    return m_controlMeasure->GetLineResidual();
  }
 
 
  double BundleMeasure::xFocalPlaneResidual() const {
    return m_xFocalPlaneResidual;
  }
 
 
  double BundleMeasure::yFocalPlaneResidual() const {
    return m_yFocalPlaneResidual;
  }
 
 
  double BundleMeasure::sigma() const {
    return m_sigma;
  }
 
 
  double BundleMeasure::weightSqrt() const {
    return m_weightSqrt;
  }
 
 
  double BundleMeasure::weight() const {
    return m_weightSqrt*m_weightSqrt;
  }
 
 
  double BundleMeasure::residualMagnitude() const {
    return m_controlMeasure->GetResidualMagnitude();
  }
 
 
  QString BundleMeasure::cubeSerialNumber() const {
    return m_controlMeasure->GetCubeSerialNumber();
  }
 
 
  double BundleMeasure::focalPlaneComputedX() const {
    return m_controlMeasure->GetFocalPlaneComputedX();
  }
 
 
   double BundleMeasure::focalPlaneComputedY() const {
     return m_controlMeasure->GetFocalPlaneComputedY();
   }
 
 
  double BundleMeasure::focalPlaneMeasuredX() const {
    return m_controlMeasure->GetFocalPlaneMeasuredX();
  }
 
 
  double BundleMeasure::focalPlaneMeasuredY() const {
    return m_controlMeasure->GetFocalPlaneMeasuredY();
  }
 
 
  void BundleMeasure::setFocalPlaneResidualsMillimeters() {
    m_xFocalPlaneResidual = m_controlMeasure->GetFocalPlaneMeasuredX() -
                            m_controlMeasure->GetFocalPlaneComputedX();
 
    m_yFocalPlaneResidual = m_controlMeasure->GetFocalPlaneMeasuredY() -
                            m_controlMeasure->GetFocalPlaneComputedY();
  }
 
 
  void BundleMeasure::setSigma(double sigmaMultiplier) {
    // TODO fix for CSM
    m_sigma = sigmaMultiplier * m_controlMeasure->Camera()->PixelPitch();
 
    if (m_sigma <= 0.0) {
      QString msg = "In BundleMeasure::setMeasureSigma(): m_measureSigma must be positive\n";
      throw IException(IException::Programmer, msg, _FILEINFO_);
    }
 
    m_weightSqrt = 1.0/m_sigma;
  }
 
 
  int BundleMeasure::observationIndex() const {
    if (!m_parentObservation) {
      QString msg = "In BundleMeasure::observationIndex: "
                    "parent observation has not been set.\n";
      throw IException(IException::Programmer, msg, _FILEINFO_);
    }
    return m_parentObservation->index();
  }
 
}