BundleObservation.cpp

 
/* SPDX-License-Identifier: CC0-1.0 */
 
#include "BundleObservation.h"
 
#include <QDebug>
#include <QString>
#include <QStringList>
#include <QVector>
 
#include "BundleImage.h"
#include "BundleObservationSolveSettings.h"
#include "BundleTargetBody.h"
#include "Camera.h"
#include "LinearAlgebra.h"
#include "SpicePosition.h"
#include "SpiceRotation.h"
 
using namespace std;
 
namespace Isis {
 
  BundleObservation::BundleObservation() {
    m_serialNumbers.clear();
    m_imageNames.clear();
    m_observationNumber = "";
    m_instrumentId = "";
    m_index = 0;
    m_weights.clear();
    m_corrections.clear();
    m_aprioriSigmas.clear();
    m_adjustedSigmas.clear();
  }
 
 
  BundleObservation::BundleObservation(BundleImageQsp image, QString observationNumber,
                                       QString instrumentId, BundleTargetBodyQsp bundleTargetBody) {
    m_serialNumbers.clear();
    m_imageNames.clear();
    m_observationNumber = "";
    m_instrumentId = "";
    m_index = 0;
    m_weights.clear();
    m_corrections.clear();
    m_aprioriSigmas.clear();
    m_adjustedSigmas.clear();
 
    m_observationNumber = observationNumber;
    m_instrumentId = instrumentId;
 
    if (image) {
      append(image);
      m_serialNumbers.append(image->serialNumber());
      m_imageNames.append(image->fileName());
      m_cubeSerialNumberToBundleImageMap.insert(image->serialNumber(), image);
    }
  }
 
 
  BundleObservation::BundleObservation(const BundleObservation &src) {
    m_serialNumbers = src.m_serialNumbers;
    m_cubeSerialNumberToBundleImageMap = src.m_cubeSerialNumberToBundleImageMap;
 
    m_observationNumber = src.m_observationNumber;
    m_instrumentId = src.m_instrumentId;
 
    m_index = src.m_index;
  }
 
 
  BundleObservation::~BundleObservation() {
    clear();
  }
 
 
  BundleObservation &BundleObservation::operator=(const BundleObservation &src) {
    if (&src != this) {
      m_serialNumbers = src.m_serialNumbers;
      m_cubeSerialNumberToBundleImageMap = src.m_cubeSerialNumberToBundleImageMap;
 
      m_observationNumber = src.m_observationNumber;
      m_instrumentId = src.m_instrumentId;
 
    }
 
    return *this;
  }
 
 
  void BundleObservation::append(const BundleImageQsp &value) {
    if (value) {
      m_cubeSerialNumberToBundleImageMap.insert(value->serialNumber(), value);
    }
    QVector<BundleImageQsp>::append(value);
  }
 
 
  BundleImageQsp BundleObservation::imageByCubeSerialNumber(QString cubeSerialNumber) {
    BundleImageQsp bundleImage;
 
    if (m_cubeSerialNumberToBundleImageMap.contains(cubeSerialNumber)) {
      bundleImage = m_cubeSerialNumberToBundleImageMap.value(cubeSerialNumber);
    }
 
    return bundleImage;
  }
 
 
  QString BundleObservation::instrumentId() {
    return m_instrumentId;
  }
 
 
  LinearAlgebra::Vector &BundleObservation::parameterWeights() {
    return m_weights;
  }
 
 
  LinearAlgebra::Vector &BundleObservation::parameterCorrections() {
    return m_corrections;
  }
 
 
  LinearAlgebra::Vector &BundleObservation::aprioriSigmas() {
    return m_aprioriSigmas;
  }
 
 
  LinearAlgebra::Vector &BundleObservation::adjustedSigmas() {
    return m_adjustedSigmas;
  }
 
 
  void BundleObservation::setIndex(int n) {
    m_index = n;
  }
 
 
  int BundleObservation::index() {
    return m_index;
  }
 
 
  QStringList BundleObservation::imageNames() {
    return m_imageNames;
  }
 
 
  double BundleObservation::vtpv() {
    double vtpv = 0.0;
 
    for (int i = 0; i < (int)m_corrections.size(); i++) {
      if (m_weights[i] > 0.0) {
        vtpv += m_corrections[i]* m_corrections[i] * m_weights[i];
      }
 
    }
 
    return vtpv;
  }
}