[发明专利]多推进器的遥控式水下机器人轨迹跟踪控制方法

说明书

本发明公开了一种多推进器的遥控式水下机器人轨迹跟踪控制方法，用于解决现有水下机器人控制方法实用性差的技术问题。技术方案是基于ROV体坐标系的运动方程建立ROV的两个基本坐标系分别为固定坐标系和运动坐标系，选取的坐标系有：地心惯性坐标O_ex_iy_iz_i、地球坐标系O_ex_ey_ez_e、地理坐标系Ox_ny_nz_n和ROV体坐标系Ox_by_bz_b，通过定义跟踪误差，取控制律，实现水下机器人控制。本发明利用轨迹跟踪控制器，不需要准确的数学模型，具有结构简单、参数整定方便、易于工业实现和适用面广等优点，通过调整参数使系统得到满意的控制效果。

技术领域

本发明涉及一种水下机器人控制方法，特别涉及一种多推进器的遥控式水下机器人轨迹跟踪控制方法。

背景技术

由于ROV(遥控式水下机器人)运动惯性比较大、水动力系数不确定、机械手的作业运动影响机器人主体的动力学特性，且存在海流等随机干扰，其动力学模型难以确定，而且具有强耦合和非线性的特点，导致ROV难于控制。随着ROV应用范围的扩大，对其自主性、运动控制的精度和稳定性的要求都随之增加，如何提高其运动控制性能成了研究的重要课题。

水下机器人是一个非常复杂的系统，要建立精确的数学运动模型是非常困难的，从而难以通过计算机仿真确定其控制参数。随着控制技术的不断发展，智能控制技术不断涌现，如神经网络、模糊控制、自适应控制等多种智能控制技术。俞建成、张艾群、王晓辉、苏立娟在《自动化学报》2007年08期第840-846页发表的“基于模糊神经网络水下机器人直接自适应控制”提出了基于广义动态模糊神经网络的水下机器人直接自适应控制方法，该控制方法完全通过在线自适应学习算法构建水下机器人的逆动力学模型，提出了基于这种网络结构的水下机器人直接自适应控制器，使用直接自适应控制器对水下机器人进行控制。但该控制方法的参数调试繁琐，且适应性不强，在工程实际应用中难以实现。

发明内容

为了克服现有水下机器人控制方法实用性差的不足，本发明提供一种多推进器的遥控式水下机器人轨迹跟踪控制方法。该方法基于ROV体坐标系的运动方程建立ROV的两个基本坐标系分别为固定坐标系和运动坐标系，选取的坐标系有：地心惯性坐标O_ex_iy_iz_i、地球坐标系O_ex_ey_ez_e、地理坐标系Ox_ny_nz_n和ROV体坐标系Ox_by_bz_b，通过定义跟踪误差，取控制律，实现水下机器人控制。本发明利用轨迹跟踪控制器，不需要准确的数学模型，具有结构简单、参数整定方便、易于工业实现和适用面广等优点，通过调整参数使系统得到满意的控制效果。

本发明解决其技术问题所采用的技术方案：一种多推进器的遥控式水下机器人轨迹跟踪控制方法，其特点是包括以下步骤：

步骤一、基于ROV体坐标系的运动方程如下：

其中M为广义质量正定矩阵，为水下机器人位置与偏航角，v＝[u_r v_rr]为广义水流速度，u_r为纵向速度，v_r为横侧向速度，r为偏航角速率，为偏航角，C(v)为广义阻力系数斜对称矩阵，D(v)为流体动力学参数，τ_c为控制力矩向量；