本文整理汇总了C++中VertexSE3::edges方法的典型用法代码示例。如果您正苦于以下问题:C++ VertexSE3::edges方法的具体用法?C++ VertexSE3::edges怎么用?C++ VertexSE3::edges使用的例子?那么恭喜您, 这里精选的方法代码示例或许可以为您提供帮助。您也可以进一步了解该方法所在类VertexSE3
的用法示例。
在下文中一共展示了VertexSE3::edges方法的1个代码示例,这些例子默认根据受欢迎程度排序。您可以为喜欢或者感觉有用的代码点赞,您的评价将有助于系统推荐出更棒的C++代码示例。
示例1: extractRelativePrior
bool extractRelativePrior(Eigen::Isometry3f& priorMean, Matrix6f& priorInfo,
const DrawableFrame* reference, const DrawableFrame* current){
VertexSE3* referenceVertex =reference->_vertex;
VertexSE3* currentVertex =current->_vertex;
bool priorFound = false;
priorInfo.setZero();
for (HyperGraph::EdgeSet::const_iterator it=referenceVertex->edges().begin();
it!= referenceVertex->edges().end(); it++){
const EdgeSE3* e = dynamic_cast<const EdgeSE3*>(*it);
if (e->vertex(0)==referenceVertex && e->vertex(1) == currentVertex){
priorFound=true;
for (int c=0; c<6; c++)
for (int r=0; r<6; r++)
priorInfo(r,c) = e->information()(r,c);
for(int c=0; c<4; c++)
for(int r=0; r<3; r++)
priorMean.matrix()(r,c) = e->measurement().matrix()(r,c);
priorMean.matrix().row(3) << 0,0,0,1;
}
}
return priorFound;
}