diff --git a/src/converter.hh b/src/converter.hh index 1734644c1febd467126ee067d160925a0bc6d20d..2e116615d547b7157f14c4a66bccfb9c3c3b182c 100644 --- a/src/converter.hh +++ b/src/converter.hh @@ -71,10 +71,16 @@ namespace dynamicgraph // Vector3 SOT_TO_ROS_IMPL(specific::Vector3) { - assert (src.size () == 3); - dst.x = src.elementAt (0); - dst.y = src.elementAt (1); - dst.z = src.elementAt (2); + if (src.size () > 0) + { + dst.x = src.elementAt (0); + if (src.size () > 1) + { + dst.y = src.elementAt (1); + if (src.size () > 2) + dst.z = src.elementAt (2); + } + } } ROS_TO_SOT_IMPL(specific::Vector3)