论文部分内容阅读
利用ROV代替潜水员进行潜艇供排气管对接作业是援潜救生的发展趋势,其中供排气管对接技术是为失事艇员提供生命保障的关键技术。由于水下作业环境比较复杂以及水下作业难度大等特点,人工遥控ROV进行援潜对接供排空气管作业过程中,还停留在只是能够打开潜艇供排气系统花甲板盖的工作上,还没有实现对类似接通供排空气管精确作业的工作。受到海流、风浪、失事潜艇周围较大涡流、供排气管的拖曳阻力、水下可视条件以及高精度定位等因素的限制,作业任务越复杂,要求ROV系统上机械手精确定位精度越高,操纵的难度也越大,由人工操作很难实现。在现有ROV人工操作的基础上,使ROV系统具有自主作业功能,更能发挥其在对接空气管作业中的能力,提高作业效率,缩短救援时间,因此本文在现有ROV基础上扩展预编程自主控制驾驶功能模块即ROV-A系统,借助预编程技术ROV-A系统在对接空气管作业中的一些特殊任务时能够实现自主作业功能。
本文结合中国科学院沈阳自动化研究所水下机器人中心未来援潜救生关键技术研究内容,针对为失事潜艇接通空气管作业中的一些关键技术,开展基于具有自主作业能力的ROV-A系统自主作业方法研究,深入研究了具有自主作业能力ROV-A系统的运动规划与协调控制技术以及水下作业力控制技术,以实现高精度的机械手末端位置控制与期望力跟踪;针对潜艇供排气系统的已知结构研究了水下目标定位技术,为对接空气管的特定需求发展具有自主作业能力的水下作业技术提供理论依据。重点研究针对系统特点的运动规划与多性能指标实现归一化问题;研究基于系统动力学模型误差的系统位姿控制问题:研究基于阻抗力控制水下作业目标定位问题;在系统运动规划与控制研究的基础上,研究能实现机械手末端精确轨迹跟踪的控制策略问题以及力控制问题。本论文研究内容如下:
(1)根据ROV-A系统特点,从描述系统的空间位置和姿态着手,研究了ROV-A系统的空间运动学与基于Kane方法的动力学,得出载体基座自由运动模式的系统空间运动数学模型,为论文后续研究工作奠定了基础。
(2)针对对接空气管作业中的一些高精度和复杂的作业,研究了系统作业时的运动规划问题。针对系统运动学冗余、作业规划约束性能指标多,例如机械手可操作性,关节限制,载体的姿态,避障等等,结合梯度投影法和最小范数伪逆矩阵法以及任务优先逆运动学方法,引入模糊控制技术,将模糊控制的定性知识表达与任务优先逆运动学算法相结合,以水下作业末端位置控制及轨迹跟踪为前提,对系统运动分配、关节限位、避免奇异有无海流下的系统性能优化等运动规划进行了研究,仿真证明运动规划算法的有效性。
(3)研究了基于动力学模型的系统基本控制问题。针对系统动力学模型的复杂性和不精确性,在基于载体输出反馈控制的基础上,设计了基于输出反馈自适应控制算法,通过自适应学习的方式直接逼近系统动力学方程状态量之间的非线性关系,在外界不停扰动下逐渐提高系统的控制精度;基于Lyapunov稳定性理论,证明了存在外界干扰和自适应逼近误差条件下ROV-A系统控制器的闭环稳定性;通过仿真实验验证控制系统的有效性,为系统的控制提供了一种新思路。同时在基于位置运动控制的基础上引入了力控制,通过对常规PID外环力控制器基础上的改进,在系统离线规划的前提下实现力与位置控制的解耦,通过仿真验证期望力的稳定跟踪。
(4)研究了基于ROV-A系统阻抗力控制的水下矩形围壁环境约束的位置定位方法。通过在对具有先验知识的矩形围壁环境约束的学习理解基础上,应用外部阻抗力控制环包容内部位置运动控制环的控制策略。利用力传感器的反馈信息变化确定系统末端执行器与约束环境的接触特征点,根据环境的先验知识推理出环境定位信息。通过计算机仿真实验验证了水下具有先验知识环境的定位方法和ROV-A系统的控制策略的有效性。仿真结果证明定位方法和控制策略是可行的。
(5)结合系统控制,分析了系统在为失事潜艇对接空气管作业中的恒定和时变两种期望力输入作业模式,提出了基于在线运动规划下外部力控制环包容内部位置环控制方法,利用ROV-A系统完成了为失事潜艇自主对接空气管中两个典型作业。介绍了整个控制方法的组成和执行过程,分析了综合控制策略,最后通过仿真实验分析了综合力控制方法的性能,包括恒力和时变期望力输入进行了深入研究。