Merge pull request RainerKuemmerle#327 from felixendres/patch-2

Fix bug, that sets the 2nd offset to the 1st
bingyingL · Dec 8, 2018 · 9527c07 · 9527c07
2 parents e48bf30 + 184e809
commit 9527c07
Showing 1 changed file with 1 addition and 1 deletion.
diff --git a/g2o/types/slam3d/edge_se3_offset.cpp b/g2o/types/slam3d/edge_se3_offset.cpp
@@ -51,7 +51,7 @@ namespace g2o {
     ParameterVector pv(2);
     pv[0]=_offsetFrom;
     resolveCache(_cacheFrom, (OptimizableGraph::Vertex*)_vertices[0],"CACHE_SE3_OFFSET",pv);
-    pv[1]=_offsetTo;
+    pv[0]=_offsetTo;
     resolveCache(_cacheTo, (OptimizableGraph::Vertex*)_vertices[1],"CACHE_SE3_OFFSET",pv);
     return (_cacheFrom && _cacheTo);
   }