getNonlinearFactor
parent
1b9b90803a
commit
659caa58c1
|
|
@ -28,6 +28,13 @@ using namespace gtsam;
|
||||||
|
|
||||||
BOOST_PYTHON_MEMBER_FUNCTION_OVERLOADS(print_overloads, NonlinearFactorGraph::print, 0, 1);
|
BOOST_PYTHON_MEMBER_FUNCTION_OVERLOADS(print_overloads, NonlinearFactorGraph::print, 0, 1);
|
||||||
|
|
||||||
|
boost::shared_ptr<NonlinearFactor> getNonlinearFactor(
|
||||||
|
const NonlinearFactorGraph& graph, size_t idx) {
|
||||||
|
auto p = boost::dynamic_pointer_cast<NonlinearFactor>(graph.at(idx));
|
||||||
|
if (!p) throw std::runtime_error("No NonlinearFactor at requested index");
|
||||||
|
return p;
|
||||||
|
};
|
||||||
|
|
||||||
void exportNonlinearFactorGraph(){
|
void exportNonlinearFactorGraph(){
|
||||||
|
|
||||||
typedef NonlinearFactorGraph::sharedFactor sharedFactor;
|
typedef NonlinearFactorGraph::sharedFactor sharedFactor;
|
||||||
|
|
@ -44,4 +51,6 @@ void exportNonlinearFactorGraph(){
|
||||||
.def("print", &NonlinearFactorGraph::print, print_overloads(args("s")))
|
.def("print", &NonlinearFactorGraph::print, print_overloads(args("s")))
|
||||||
;
|
;
|
||||||
|
|
||||||
|
def("getNonlinearFactor", getNonlinearFactor);
|
||||||
|
|
||||||
}
|
}
|
||||||
|
|
|
||||||
Loading…
Reference in New Issue