BundleLidarPointVector.cpp

#include "BundleLidarPointVector.h"
 
#include <QDebug>
#include <QFutureWatcher>
#include <QtConcurrentRun>
 
#include "BundleTargetBody.h"
#include "IException.h"
 
namespace Isis {
 
  BundleLidarPointVector::BundleLidarPointVector() {
  }
 
 
  BundleLidarPointVector::BundleLidarPointVector(const BundleLidarPointVector &src)
      :QVector<BundleLidarControlPointQsp>(src) {
  }
 
 
  BundleLidarPointVector::~BundleLidarPointVector() {
    clear();
  }
 
 
  BundleLidarPointVector &BundleLidarPointVector::operator=(const BundleLidarPointVector &src) {
    if (&src != this) {
      QVector<BundleLidarControlPointQsp>::operator=(src);
    }
    return *this;
  }
 
 
  void BundleLidarPointVector::applyParameterCorrections(SparseBlockMatrix &normalsMatrix,
                                                         LinearAlgebra::Vector &imageSolution,
                                                         const BundleTargetBodyQsp target) {
    for (int i = 0; i < size(); i++) {
      at(i)->applyParameterCorrections(imageSolution, normalsMatrix, target);
    }
  }
 
 
  void BundleLidarPointVector::computeMeasureResiduals() {
 
    for (int i = 0; i < size(); i++) {
      at(i)->computeResiduals();
    }
  }
 
 
  double BundleLidarPointVector::vtpvMeasureContribution() {
    double vtpv = 0.0;
 
    for (int i = 0; i < size(); i++) {
      vtpv += at(i)->vtpvMeasures();
    }
 
    return vtpv;
  }
 
 
  double BundleLidarPointVector::vtpvContribution() {
    double vtpvControl = 0.0;
 
    for (int i = 0; i < size(); i++) {
      vtpvControl += at(i)->vtpv();
    }
 
    return vtpvControl;
  }
 
 
  double BundleLidarPointVector::vtpvRangeContribution() {
    double vtpvRange = 0.0;
 
    for (int i = 0; i < size(); i++) {
        vtpvRange += at(i)->vtpvRangeContribution();
    }
 
    return vtpvRange;
  }
 
}