diff --git a/src/landmark_polyline_2D.cpp b/src/landmark_polyline_2D.cpp
index bc1bcc71abedb342e2003498844593db8e538b36..d117754206d53c9a409e5e04e6e92548a0249d12 100644
--- a/src/landmark_polyline_2D.cpp
+++ b/src/landmark_polyline_2D.cpp
@@ -60,7 +60,7 @@ void LandmarkPolyline2D::setLast(const Eigen::VectorXs& _point, bool _defined)
     	defineExtreme(true);
 }
 
-const Eigen::VectorXs& LandmarkPolyline2D::getPointVector(int _i) const
+const Eigen::VectorXs LandmarkPolyline2D::getPointVector(int _i) const
 {
 	//std::cout << "LandmarkPolyline2D::getPointVector: " << _i << std::endl;
 	//std::cout << "First: " << first_id_ << " - size: " << point_state_ptr_vector_.size() << std::endl;
diff --git a/src/landmark_polyline_2D.h b/src/landmark_polyline_2D.h
index d2b8fb8f93e92896f85bcdd30b641346a9d1a754..a44a00b4cf5cf3aef2c560693e3232560e01a63a 100644
--- a/src/landmark_polyline_2D.h
+++ b/src/landmark_polyline_2D.h
@@ -72,7 +72,7 @@ class LandmarkPolyline2D : public LandmarkBase
 		int getFirstId() const;
 		int getLastId() const;
 
-        const Eigen::VectorXs& getPointVector(int _i) const;
+        const Eigen::VectorXs getPointVector(int _i) const;
 
         StateBlockPtr getPointStateBlockPtr(int _i);