curve_constraint.h

Go to the documentation of this file.

 
#ifndef _CLASS_CURVE_CONSTRAINT
#define _CLASS_CURVE_CONSTRAINT
 
#include <functional>
#include <vector>
 
#include "MathDefs.h"
#include "serialization/archive.hpp"
#include "serialization/eigen-matrix.hpp"
 
namespace ndcurves {
template <typename Point>
struct curve_constraints : serialization::Serializable {
  typedef Point point_t;
  curve_constraints(const size_t dim = 3)
      : init_vel(point_t::Zero(dim)),
        init_acc(point_t::Zero(dim)),
        init_jerk(point_t::Zero(dim)),
        end_vel(point_t::Zero(dim)),
        end_acc(point_t::Zero(dim)),
        end_jerk(point_t::Zero(dim)),
        dim_(dim) {}
 
  curve_constraints(const curve_constraints& other)
      : init_vel(other.init_vel),
        init_acc(other.init_acc),
        init_jerk(other.init_jerk),
        end_vel(other.end_vel),
        end_acc(other.end_acc),
        end_jerk(other.end_jerk),
        dim_(other.dim_) {}

  virtual bool operator==(const curve_constraints& other) const {
    return dim_ == other.dim_ && init_vel == other.init_vel &&
           init_acc == other.init_acc && init_jerk == other.init_jerk &&
           end_vel == other.end_vel && end_acc == other.end_acc &&
           end_jerk == other.end_jerk;
  }

  virtual bool operator!=(const curve_constraints& other) const {
    return !(*this == other);
  }
 
  virtual ~curve_constraints() {}
  point_t init_vel;
  point_t init_acc;
  point_t init_jerk;
  point_t end_vel;
  point_t end_acc;
  point_t end_jerk;
  size_t dim_;
 
  // Serialization of the class
  friend class boost::serialization::access;
  template <class Archive>
  void serialize(Archive& ar, const unsigned int version) {
    if (version) {
      // Do something depending on version ?
    }
    ar& boost::serialization::make_nvp("init_vel", init_vel);
    ar& boost::serialization::make_nvp("init_acc", init_acc);
    ar& boost::serialization::make_nvp("init_jerk", init_jerk);
    ar& boost::serialization::make_nvp("end_vel", end_vel);
    ar& boost::serialization::make_nvp("end_acc", end_acc);
    ar& boost::serialization::make_nvp("end_jerk", end_jerk);
    ar& boost::serialization::make_nvp("dim", dim_);
  }
};
}  // namespace ndcurves
#endif  //_CLASS_CUBICZEROVELACC