Code cleanup (ROS formatting)