Hi Yang Fan,
Thanks for the post. Feedback control for self-balancing is already built into the ArduSub code that runs on the Pixhawk. You do not need to implement this separately in ROS.
Please see the "ATC-*" parameter section for the attitude control PID parameters, which you can adjust to make the vehicle more or less responsive.
Are you using ArduSub for the ROV?