Skip to content

Commit

Permalink
fix g2o vector error
Browse files Browse the repository at this point in the history
  • Loading branch information
koide3 committed Oct 17, 2019
1 parent b7f6c22 commit 33663ce
Showing 1 changed file with 3 additions and 3 deletions.
6 changes: 3 additions & 3 deletions include/g2o/edge_plane_identity.hpp
Original file line number Diff line number Diff line change
Expand Up @@ -63,18 +63,18 @@ class EdgePlaneIdentity : public BaseBinaryEdge<4, Eigen::Vector4d, VertexPlane,
return os.good();
}

virtual void setMeasurement(const Vector4& m) override {
virtual void setMeasurement(const Eigen::Vector4d& m) override {
_measurement = m;
}

virtual bool setMeasurementData(const number_t* d) override {
Eigen::Map<const Vector4> m(d);
Eigen::Map<const Eigen::Vector4d> m(d);
_measurement = m;
return true;
}

virtual bool getMeasurementData(number_t* d) const override {
Eigen::Map<Vector4> m(d);
Eigen::Map<Eigen::Vector4d> m(d);
m = _measurement;
return true;
}
Expand Down

0 comments on commit 33663ce

Please sign in to comment.