diff --git a/src/ros_import.cpp b/src/ros_import.cpp index 7998fc0726b8b731668fb599320c33f7b1ba0202..a6990e6a873875f971ce82a352c0674572ea5f06 100644 --- a/src/ros_import.cpp +++ b/src/ros_import.cpp @@ -81,6 +81,11 @@ namespace dynamicgraph entity.add<ml::Matrix> (signal, topic); else if (type == "vector") entity.add<ml::Vector> (signal, topic); + else if (type == "matrixHomo") + entity.add<sot::MatrixHomogeneous> (signal, topic); + else if (type == "matrixHomoStamped") + entity.add<std::pair<sot::MatrixHomogeneous, ml::Vector> > + (signal, topic); else throw std::runtime_error("bad type"); return Value ();