PinholeFactor.h

Go to the documentation of this file.

/* ----------------------------------------------------------------------------

 * GTSAM Copyright 2010, Georgia Tech Research Corporation,
 * Atlanta, Georgia 30332-0415
 * All Rights Reserved
 * Authors: Frank Dellaert, et al. (see THANKS for the full author list)

 * See LICENSE for the license information

 * -------------------------------------------------------------------------- */

#pragma once

namespace gtsam {
template <typename T>
struct traits;
}

#include <gtsam/geometry/Cal3Bundler.h>
#include <gtsam/geometry/PinholeCamera.h>
#include <gtsam/geometry/Pose3.h>
#include <gtsam/slam/SmartFactorBase.h>

namespace gtsam {

class PinholeFactor : public SmartFactorBase<PinholeCamera<Cal3Bundler> > {
 public:
  typedef SmartFactorBase<PinholeCamera<Cal3Bundler> > Base;
  PinholeFactor() {}
  PinholeFactor(const SharedNoiseModel& sharedNoiseModel,
                std::optional<Pose3> body_P_sensor = {},
                size_t expectedNumberCameras = 10)
      : Base(sharedNoiseModel, body_P_sensor, expectedNumberCameras) {}
  double error(const Values& values) const override { return 0.0; }
  std::shared_ptr<GaussianFactor> linearize(
      const Values& values) const override {
    return std::shared_ptr<GaussianFactor>(new JacobianFactor());
  }
};

template <>
struct traits<PinholeFactor> : public Testable<PinholeFactor> {};

}  // namespace gtsam