[catkin, roscpp, swri_math_util]