message: fix dist to center calc for eigen dynamic constructor
diff: @@ -20,15 +20,9 @@ namespace geometry {
  //! templated polygon class with a boost polygon as a member function
  template <typename T>
  struct Polygon_t : public Shape<bg::model::polygon<T>, T> {
  - Polygon_t() : Shape<bg::model::polygon<T>, T>(Pose(0, 0, 0), std::vector<T>(), 0),
  - rear_dist_(0.0f),
  - front_dist_(0.0f),
  - left_dist_(0.0f),
  - right_dist_(0.0f) {}
  + Polygon_t();
  Polygon_t(const Pose &center, const std::vector<T> points);
  - Polygon_t(
  - const Pose &center,
  - const Eigen::Matrix<float, Eigen::Dynamic, Eigen::Dynamic> &points) : Shape<bg::model::polygon<T>, T>(center, points, 0) {}
  + Polygon_t(const Pose &center, const Eigen::Matrix<float, Eigen::Dynamic, Eigen::Dynamic> &points);
  virtual Eigen::Matrix<float, Eigen::Dynamic, Eigen::Dynamic> toArray() const;
  @@ -42,6 +36,13 @@ struct Polygon_t : public Shape<bg::model::polygon<T>, T> {
  float right_dist_;
  };
  +template<typename T>
  +inline Polygon_t<T>::Polygon_t() : Shape<bg::model::polygon<T>, T>(Pose(0, 0, 0), std::vector<T>(), 0),
  + rear_dist_(0.0f),
  + front_dist_(0.0f),
  + left_dist_(0.0f),
  + right_dist_(0.0f) {}
  +
  template<typename T>
  inline Polygon_t<T>::Polygon_t(const Pose &center, const std::vector<T> points) :
  Shape<bg::model::polygon<T>, T>(center, points, 0),
  @@ -49,7 +50,17 @@ inline Polygon_t<T>::Polygon_t(const Pose &center, const std::vector<T> points)
  front_dist_(0.0f),
  left_dist_(0.0f),
  right_dist_(0.0f) {
  + UpdateDistancesToCenter();
  +}
  +template<typename T>
  +inline Polygon_t<T>::Polygon_t(const Pose &center,
  + const Eigen::Matrix<float, Eigen::Dynamic, Eigen::Dynamic> &points) :
  + Shape<bg::model::polygon<T>, T>(center, points, 0),
  + rear_dist_(0.0f),
  + front_dist_(0.0f),
  + left_dist_(0.0f),
  + right_dist_(0.0f) {
  UpdateDistancesToCenter();
  }
  