液压推进型水下机器人的运动控制方法研究

Motion control method of underwater vehicle with hydraulic thrusters

针对液压推进型水下机器人的定向控制问题,对液压推进器的比例滞环、机器人多自由度运动模型、控制器设计等方面进行了研究,提出了液压推进器转速PI控制与ROV定向PID控制相结合的控制方法;在Matlab/Simulink中建立了海马号水下机器人的六自由度动力学模型,并设计了带螺旋桨转速PI闭环的定向控制器;该定向控制器包括控制手柄输入、定向PID控制器、推力分配及合成矩阵、螺旋桨转速PI控制器等,利用仿真试验模型对控制器进行了抗干扰测试。仿真结果表明:所提出的复合PID控制器可显著减小由于液压推进器推力不一致引起的定向角度控制误差,具有比常规PID控制器更好的控制性能。

Aiming at the heading control problems of underwater vehicle with hydraulic thrusters,the proportional hysteresis,the multi-degree-of-freedom model of the robot,the design of the controller and so on were studied. A control method combining the thruster speed PI control and the heading PID control was proposed. The 6 degree of freedom model of Hama ROV was established in Matlab/Simulink,and a heading controller with the thruster speed PI loop was designed. This heading controller includes control handle input,a heading PID controller,thrust distribution and synthesis matrix,propeller rotation PI controllers. The simulation model was used to test the anti-interference performance of the controller. The simulation results indicate that this combined PID controller can decrease the angle error caused by the thrust imblance of the thrusters,and has better control performance compared with normal PID controller.