[发明专利]基于迭代的自主水下航行器三维曲线路径跟踪控制方法有效

专利信息
申请号: 201210211449.3 申请日: 2012-06-26
公开(公告)号: CN102768539A 公开(公告)日: 2012-11-07
发明(设计)人: 王宏健;陈子印;于乐;陈兴华;吕洪莉 申请(专利权)人: 哈尔滨工程大学
主分类号: G05D1/10 分类号: G05D1/10
代理公司: 暂无信息 代理人: 暂无信息
地址: 150001 黑龙江省哈尔滨市南岗区*** 国省代码: 黑龙江;23
权利要求书: 查看更多 说明书: 查看更多
摘要:
搜索关键词: 基于 自主 水下 航行 三维 曲线 路径 跟踪 控制 方法
【权利要求书】:

1.一种基于迭代的自主水下航行器三维曲线路径跟踪控制方法,其特征是:

步骤1.初始化,给定三维空间期望跟踪路径参数化方程描述,给定AUV初始位置和姿态信息,给定期望跟踪路径参数的初始值,给定期望路径上“虚拟向导”初始位置和初始移动速度信息;

步骤2.计算初始时刻AUV当前位置与期望路径上“虚拟向导”点在AUV载体坐标系下的相对跟踪误差;

步骤3.计算期望路径上“虚拟向导”点的期望移动速度、AUV运动学跟踪控制律,包括纵向移动速度、AUV的转艏角速度和纵倾角速度虚拟控制律;

步骤4.在运动学等价控制律的基础上,采用迭代,推导欠驱动自主水下航行器AUV的三维路径跟踪的动力学控制律,即根据AUV具体水动力数学模型解算出最终的执行指令信号,包括推进器推力、纵倾控制力矩和转艏控制力矩;

步骤5.计算当前AUV位置ηn=(x,y,z)与标定的转向点WPk=(xk,yk,zk)之间的距离若小于设定的航迹切换半径R,则表示完成当前指定路径的跟踪任务停止航行或切换下一个期望航迹,否则继续步骤2。

2.根据权利要求1所述的基于迭代的自主水下航行器三维曲线路径跟踪控制方法,其特征是:给定期望跟踪路径Ω上的虚拟向导P在固定坐标系的坐标表示为某一标量参数s∈R的函数为

ηdn(s)=[xd(s),yd(s),zd(s)]T]]>

为了保证被跟踪路径的光滑性,要求xd(s),yd(s),zd(s)二阶偏导数存在;

定义虚拟向导点P的速度up方向为沿曲线路径的切线方向与固定坐标系水平轴的夹角ψd

ψd=arctan(y′d/x′d)

速度向量up与固定坐标系垂直轴的夹角θd定义为

θd=tan-1(-zd(xd)2+(yd)2)]]>

其中因此虚拟向导点P沿曲线路径的旋转角速度分别表示为

qd=θ·d]]>

rd=ψ·d]]>

然后给定AUV在固定坐标系下的初始位置为ηn=[x,y,z]T,AUV的初始艏向角和纵倾角分别为ψ和θ,AUV纵向速度u、横向速度v和垂向速度w,艏摇角速度r和纵倾角速度q。

下载完整专利技术内容需要扣除积分,VIP会员可以免费下载。

该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于哈尔滨工程大学,未经哈尔滨工程大学许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服

本文链接:http://www.vipzhuanli.com/pat/books/201210211449.3/1.html,转载请声明来源钻瓜专利网。

×

专利文献下载

说明:

1、专利原文基于中国国家知识产权局专利说明书;

2、支持发明专利 、实用新型专利、外观设计专利(升级中);

3、专利数据每周两次同步更新,支持Adobe PDF格式;

4、内容包括专利技术的结构示意图流程工艺图技术构造图

5、已全新升级为极速版,下载速度显著提升!欢迎使用!

请您登陆后,进行下载,点击【登陆】 【注册】

关于我们 寻求报道 投稿须知 广告合作 版权声明 网站地图 友情链接 企业标识 联系我们

钻瓜专利网在线咨询

周一至周五 9:00-18:00

咨询在线客服咨询在线客服
tel code back_top