catkinization
TODO: still problems compiling with rviz_imu_plugin package