Go to the documentation of this file.00001
00002
00003
00004
00005
00006
00007
00008
00009
00010
00011
00012
00013
00014
00015
00016
00017 #include "edge_se2_pointxy.h"
00018 #ifdef __APPLE__
00019 #include <OpenGL/gl.h>
00020 #else
00021 #include <GL/gl.h>
00022 #endif
00023
00024 namespace g2o {
00025 namespace tutorial {
00026
00027 EdgeSE2PointXY::EdgeSE2PointXY() :
00028 BaseBinaryEdge<2, Vector2d, VertexSE2, VertexPointXY>()
00029 {
00030 }
00031
00032 bool EdgeSE2PointXY::read(std::istream& is)
00033 {
00034 is >> measurement()[0] >> measurement()[1];
00035 inverseMeasurement() = measurement() * -1;
00036 is >> information()(0,0) >> information()(0,1) >> information()(1,1);
00037 information()(1,0) = information()(0,1);
00038 return true;
00039 }
00040
00041 bool EdgeSE2PointXY::write(std::ostream& os) const
00042 {
00043 os << measurement()[0] << " " << measurement()[1] << " ";
00044 os << information()(0,0) << " " << information()(0,1) << " " << information()(1,1);
00045 return os.good();
00046 }
00047
00048 }
00049 }