let's see if this fixes the rviz issue with spurious poses (but this might require adding yaml constructors...)