Migrate march_gain_scheduling to ROS 2