[ros-dev] A few bugs