文档下载 文档下载导航
设为首页 | 加入收藏
搜索 请输入内容:  
 导航当前位置: 文档下载 > 所有分类 > 工程科技 > 机械/仪表 > 6自由度水下机器人动力学分析与运动控制
侵权投诉

6自由度水下机器人动力学分析与运动控制

第43卷第7期 2007年7月

机 械 工 程 学

6自由度水下机器人动力学分析与运动控制

报

CHINESE JOURNAL OF MECHANICAL ENGINEERING

Vol.43 No.7 Jul. 2007

6自由度水下机器人动力学分析与运动控制

边宇枢 高志慧 超

(北京航空航天大学机械工程及自动化学院 北京 100083)

摘要:对6自由度水下机器人的动力学与运动控制进行研究。首先考虑重力、浮力、推力以及水动力的影响,建立水下机器人的动力学模型,对机器人的复杂水下动力学行为进行描述。在此基础上,根据解出加速度法设计非线性控制器,包括内外两个控制回路。其中外控制回路根据机器人实际轨迹与期望轨迹之间的偏差进行负反馈控制,内控制回路根据机器人动力学特性引入非线性补偿,把机器人转化为一个更易于控制的线性系统,从而准确实现对理论轨迹的跟踪。最后对水下机器人跟踪目标进行运动控制仿真。从仿真结果可以看出,利用该方法可以使水下机器人具有良好的轨迹跟踪能力。

关键词:水下机器人 运动控制 动力学 解出加速度法 中图分类号:TP242.2

*

0 前言

水下机器人能够在水下执行多种作业,因此不仅有着广泛的军事用途,而且还是开发海洋资源的重要工具。近年来,水下机器人的研究倍受重视,已成为发达国家军事海洋技术研究的前沿。由于水下环境复杂,影响运动的因素较多,因此如何设计机器人的运动控制系统是一个十分复杂的问题[1]。目前,在对水下机器人的运动控制进行研究时,多数从控制的角度出发提出多种方法,对机器人的运动偏差从外部进行纠正与补偿,使该问题得到一定程度的解决[2-3]。但是,为了更有效地提高机器人的整体运动性能,还同时需要对机器人的复杂水下动力学 行为进行深入研究。从现有的相关研究看,通常 把机器人的动力学行为简化到若干典型平面中,然后再分别对机器人在典型平面内的运动进行控 制[4-5]。显然,这对于控制水下机器人的复杂运动是不够的。

本文从动态控制的角度出发,综合考虑重力、浮力、推力和水动力的影响,建立了比较完整的6自由度水下机器人的动力学模型。在此基础上根据解出加速度法设计非线性控制器,引入非线性补偿,把机器人转化为一个更易于控制的线性系统,从而准确实现对轨迹的跟踪。

6自由度水下机器人动力学分析与运动控制

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收到修改稿

在建立坐标系的基础上,可以得出局部坐标系

到大地坐标系的速度、角速度转换矩阵分别为

第1页

你可能喜欢

热门文档

相关文档

站点地图 | 文档上传 | 侵权投诉 | 手机版
本站所有资源均来自互联网,本站只负责收集和整理,均不承担任何法律责任,如有侵权等其它行为请联系我们.
文档下载 Copyright 2013 doc.guandang.net All Rights Reserved.  -  email