第43卷第7期 2007年7月
机 械 工 程 学

报
CHINESE JOURNAL OF MECHANICAL ENGINEERING
Vol.43 No.7 Jul. 2007
6自由度水下机器人动力学分析与运动控制
边宇枢 高志慧 超
(北京航空航天大学机械工程及自动化学院 北京 100083)
摘要:对6自由度水下机器人的动力学与运动控制进行研究。首先考虑重力、浮力、推力以及水动力的影响,建立水下机器人的动力学模型,对机器人的复杂水下动力学行为进行描述。在此基础上,根据解出加速度法设计非线性控制器,包括内外两个控制回路。其中外控制回路根据机器人实际轨迹与期望轨迹之间的偏差进行负反馈控制,内控制回路根据机器人动力学特性引入非线性补偿,把机器人转化为一个更易于控制的线性系统,从而准确实现对理论轨迹的跟踪。最后对水下机器人跟踪目标进行运动控制仿真。从仿真结果可以看出,利用该方法可以使水下机器人具有良好的轨迹跟踪能力。
关键词:水下机器人 运动控制 动力学 解出加速度法 中图分类号:TP242.2
*
0 前言
水下机器人能够在水下执行多种作业,因此不仅有着广泛的军事用途,而且还是开发海洋资源的重要工具。近年来,水下机器人的研究倍受重视,已成为发达国家军事海洋技术研究的前沿。由于水下环境复杂,影响运动的因素较多,因此如何设计机器人的运动控制系统是一个十分复杂的问题[1]。目前,在对水下机器人的运动控制进行研究时,多数从控制的角度出发提出多种方法,对机器人的运动偏差从外部进行纠正与补偿,使该问题得到一定程度的解决[2-3]。但是,为了更有效地提高机器人的整体运动性能,还同时需要对机器人的复杂水下动力学 行为进行深入研究。从现有的相关研究看,通常 把机器人的动力学行为简化到若干典型平面中,然后再分别对机器人在典型平面内的运动进行控 制[4-5]。显然,这对于控制水下机器人的复杂运动是不够的。
本文从动态控制的角度出发,综合考虑重力、浮力、推力和水动力的影响,建立了比较完整的6自由度水下机器人的动力学模型。在此基础上根据解出加速度法设计非线性控制器,引入非线性补偿,把机器人转化为一个更易于控制的线性系统,从而准确实现对轨迹的跟踪。


1 机器人运动坐标系及坐标变换
为便于研究水下机器人的运动、建模与控制,需要建立两个正交坐标系,分别为大地坐标系和局部坐标系。其中,大地坐标系以发射点为原点,Ox轴、Oy轴在水平面内,Oz轴沿铅垂方向竖直向下,如图1所示。为便于描述刚体运动,在水下机器人上建立如图2所示的局部坐标系。该坐标系的原点与机器人的重心重合,O' x' 轴沿水下机器人的纵轴方向,O'y' 轴垂直O'x' 轴并指向右舷方向,O'z' 轴垂直于O'x' 轴与O'y' 轴组成的平面,其方向按右手定则判定。
图1 大地坐标系
图2 局部坐标系
国家自然科学基金(50075008)和国家高技术研究发展计划(863计划,2001AA421200)资助项目。20060709收到初稿,20070131收到修改稿
在建立坐标系的基础上,可以得出局部坐标系
到大地坐标系的速度、角速度转换矩阵分别为
6自由度水下机器人动力学分析与运动控制_环境科学/食品科学_工程科技_专业资料。具有较高的参考价值和实用价值维普资讯 http://www.cqvip.com 第4 3卷第 7期...
万 方数据 万 方数据 万 方数据 万 方数据 2007年7月 边宇枢等:6自由度水下机器人动力学分析与运动控制 91 徊口),实现了全局稳定的轨迹跟踪。 为了得到...
4 3 Jul. No.7 2007 6 自由度水下机器人动力学分析与运动控制* 边宇枢 高志慧 超北京 100083) (北京航空航天大学机械工程及自动化学院 摘要:对 6 自由度...
翼的推力解算方法和整个系统的动力学响应过程 为分析控制系统的物 理学特性提供...水下机器人空间 六自由度运动的一般方程如下 : 其中 Ξ 为潜艇受到的水动力 ...
6自由度水下机器人动力学... 7页 1下载券 基于ADAMS的六自由度焊接... ...浙江工业大学硕士学位论文 六自由度焊接机器人运动控制精度的分析与研究 作者姓名...
6自由度水下机器人动力学分... 7页 2财富值 六自由度喷漆机器人动力学.....1994 年, Frank C. Park 利用李群方法对机器人的运动学与动力学进 行了算法...
讨论了螺旋桨和舵、 翼的推力解算方法和整个系统的动力学响应过程. 为分析控制...环境的复杂性, 水下机器人 6 个自由度运动的强非 线性和相互耦合, 其动力学...
六自由度喷漆机器人动力学分析_数学_自然科学_专业资料。第4期 2011 年 4 ...012_Z ,) 广西教育厅科研基金(200708MS028) 制等 则由 Galil 运动控制卡...
六自由度机器人结构设计、运动学分析及仿真_机械/...这些工作为移动式机器人的结构设计、动力 学分析和...并在自动控制下执行某种操作或移动 作业任务的机械...
6自由度水下机器人动力学分... 6页 5财富值 自治水下机器人运动控制的.....关键词: 膝关节机器人 假想柔顺控制 动力学分析 PID 控制 表面肌电信号 (sEMG...
热门文档