Fixed some errors derived from the migration to ROS Indigo