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