[发明专利]基于迭代的自主水下航行器三维曲线路径跟踪控制方法有效
申请号: | 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的函数为
为了保证被跟踪路径的光滑性,要求xd(s),yd(s),zd(s)二阶偏导数存在;
定义虚拟向导点P的速度up方向为沿曲线路径的切线方向与固定坐标系水平轴的夹角ψd为
ψd=arctan(y′d/x′d)
速度向量up与固定坐标系垂直轴的夹角θd定义为
其中因此虚拟向导点P沿曲线路径的旋转角速度分别表示为
然后给定AUV在固定坐标系下的初始位置为ηn=[x,y,z]T,AUV的初始艏向角和纵倾角分别为ψ和θ,AUV纵向速度u、横向速度v和垂向速度w,艏摇角速度r和纵倾角速度q。
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于哈尔滨工程大学,未经哈尔滨工程大学许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/pat/books/201210211449.3/1.html,转载请声明来源钻瓜专利网。
- 上一篇:传送装置
- 下一篇:一种资源调度的方法和用户设备