FixedVector.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

#include <stdarg.h>
#include <gtsam/base/Vector.h>

namespace gtsam {

template<size_t N>
class FixedVector : public Eigen::Matrix<double, N, 1> {
public:
  typedef Eigen::Matrix<double, N, 1> Base;

  FixedVector() {}

  FixedVector(const FixedVector& v) : Base(v) {}

  FixedVector(const Vector& v) : Base(v) {}

  FixedVector(const double* values) {
    std::copy(values, values+N, this->data());
  }

  inline static FixedVector repeat(double value) {
    return FixedVector(Base::Constant(value));
  }

  inline static FixedVector delta(size_t i, double value) {
    return FixedVector(Base::Unit(i) * value);
  }

  inline static FixedVector basis(size_t i) { return FixedVector(Base::Unit(i)); }

  inline static FixedVector zero() { return FixedVector(Base::Zero());}

  inline static FixedVector ones() { return FixedVector(FixedVector::Ones());}

  static size_t dim() { return Base::max_size; }

  void print(const std::string& name="") const { gtsam::print(Vector(*this), name); }

  template<size_t M>
  bool equals(const FixedVector<M>& other, double tol=1e-9) const {
    return false;
  }

  bool equals(const FixedVector& other, double tol=1e-9) const {
    return equal_with_abs_tol(*this,other,tol);
  }

};


} // \namespace