[发明专利]一种无人艇状态估计观测器设计方法有效
申请号: | 202010389394.X | 申请日: | 2020-05-10 |
公开(公告)号: | CN111619761B | 公开(公告)日: | 2022-01-11 |
发明(设计)人: | 陈力恒;赵玉新;冯志光;何永旭;王烨;陈杨;郝日栩 | 申请(专利权)人: | 哈尔滨工程大学 |
主分类号: | B63B79/30 | 分类号: | B63B79/30 |
代理公司: | 暂无信息 | 代理人: | 暂无信息 |
地址: | 150001 黑龙江省哈尔滨市南岗区*** | 国省代码: | 黑龙江;23 |
权利要求书: | 查看更多 | 说明书: | 查看更多 |
摘要: | |||
搜索关键词: | 一种 无人 状态 估计 观测器 设计 方法 | ||
1.一种无人艇状态估计观测器设计方法,其特征在于,包括以下步骤:
步骤一:利用坐标变换将无人艇数学模型转化为标准形式,并设计通信网络传输方案;
步骤二:将状态变量与量化误差进行增广构造新的增广系统;
步骤三:设计基于量化数字信号的比例微分观测器,得到误差方程;
步骤四:判断误差系统的稳定性;
步骤一所述利用坐标变换将无人艇数学模型转化为标准形式具体为:
无人艇数学模型满足:
yc(t)=Ccxc(t)
其中,状态向量xc(t)=[v(t) r(t) ψ(t) p(t) φ(t)]T,干扰向量d(t)=[wψ wφ]T,控制输入u(t)=δ(t);变量v(t),ψ(t),φ(t),r(t)和p(t)分别表示舵产生的无人艇横荡速度,航向角,横摇角,平摆速度和横摇速度;δ(t)表示舵角;wφ(t)和wψ(t)表示海浪引起的横摇角和航向角的扰动;Tv和Tr是时间常数;Kvr,Kdv,Kdv,Kdr,Kdp,Kvp是已知的增益;wn和ζ分别表示无阻尼固有频率和阻尼比,系统矩阵表示为:
Cc∈Rp×5为测量输出矩阵;
假设正常的测量输出通道不小于3个,即p满足于p≥3;干扰d(t)满足于为已知的d(t)的范数最大值,求取可逆阵T∈R5×5和S∈Rp×p,将无人艇模型的参数矩阵转换为标准形式:
TAcT-1=A,TBc=B,
其中,A∈R5×5,D∈R5×2,B∈R5×1,C∈Rp×5,D1∈R2×2是可逆的;
通过坐标变换x(t)=Txc(t),y(t)=Syc(t),得到:
其中,x1(t)∈R2,y1(t)∈R2。
2.根据权利要求1所述的一种无人艇状态估计观测器设计方法,其特征在于:步骤一所述设计通信网络传输方案具体为:
设计两个相同的观测器,观测器搭1建在传感器端,用来构造估计误差;观测器2建立在控制模块中,用来对无人艇状态的监控;观测器1得到状态变量x1(t)的估计值并构造估计误差通过量化器1进行量化后利用数字传输通道同时传输到两个观测器中;另一方面,传感器将测量输出信号y2(t)直接通过量化器2量化后利用数字传输通道再次传输到两个观测器;所述两个量化器均采用如下动态均匀量化器:
其中,q(·)代表量化器输出值,为取整函数,μz量化精度;量化器1的量化误差εe(t)=q(e1)-e1(t)和量化器2的量化误差ε(t)=q(y2)-y2(t)满足于:
其中,量化器1的量化精度量μ1将实时地随着e1(t)进行更新,更新率满足于:
其中,0<k<1为给定常数;
得到带有量化数字信号的无人艇数学模型为:
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于哈尔滨工程大学,未经哈尔滨工程大学许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/pat/books/202010389394.X/1.html,转载请声明来源钻瓜专利网。