小型自主水下航行器垂直面的运动控制研究