关键词:
水下机器人-机械手系统
指数积
Kane方程
稳定性
冗余
摘要:
伴随着人类社会的发展和物质文明的进步,陆地上的资源正日益枯竭,而为了满足人类社会发展对自然资源的需求,对蕴含丰富资源的海洋的开发显得愈发重要。在对海洋环境和资源进行考察和勘探作业中,带有机械手的水下机器人系统能够完成除观察监测任务外的更为复杂的操作任务,因此对水下机器人-机械手系统(Underwater Vehicle-Manipulator System,简称UVMS)动力学建模、运动控制及运动稳定性的研究具有重要的意义。
对于基座处于自由浮动状态的UVMS,本文采用指数积公式(product exponentials formula)分析其运动学问题,计算出了UVMS各个构件的速度及加速度表达式。在运动学分析的基础之上,得到了UVMS运动过程中的惯性力,并结合UVMS运动过程中所受到的水作用力和驱动力,本文运用Kane方程建立了UVMS的动力学模型。
在UVMS的运动过程中,机械手和水下机器人存在着动力学耦合,机械手的运动会导致水下机器人的运动。为了使得机械手展开过程中对处于浮游状态的水下机器人影响最小,应合理地规划机械手的展开轨迹,本文基于动平衡理论,研究机械手展开运动对水下机器人的摆动力和摆动力矩的变化。并以此为目标函数,采用遗传算法对机械手展开运动的参数进行了优化,最终获得了机械手展开过程中对水下机器人产生的摆动力和摆动力矩最小的运动规律,并用基于动力学模型的数值仿真验证了优化结果的正确性。
为了研究UVMS的运动稳定性问题,本文参照小扰动理论,对UVMS的非线性运动方程进行了线性化处理,获得了UVMS的线性化运动方程,并用李雅普诺夫第一方法对线性化运动方程的特征根进行了稳定性判定。
在对UVMS运动学冗余的处理过程中,本文采用基于模糊逻辑的任务优先级方法,合理地规划了水下机器人和机械手的运动,并考虑了UVMS运动过程中奇异位形和关节极限问题的处理,最后用数值仿真验证了此方法的有效性。