Add rosparam_utils.cpp: utility functions for ros parameters