[发明专利]一种无缆自治水下机器人的潜浮控制方法在审
申请号: | 201410714559.0 | 申请日: | 2014-11-30 |
公开(公告)号: | CN105717936A | 公开(公告)日: | 2016-06-29 |
发明(设计)人: | 姜志斌;郑荣;刘铁军;崔健 | 申请(专利权)人: | 中国科学院沈阳自动化研究所 |
主分类号: | G05D1/10 | 分类号: | G05D1/10;G05B13/04 |
代理公司: | 沈阳科苑专利商标代理有限公司 21002 | 代理人: | 徐丽;周秀梅 |
地址: | 110016 *** | 国省代码: | 辽宁;21 |
权利要求书: | 查看更多 | 说明书: | 查看更多 |
摘要: | 本发明涉及一种无缆自治水下机器人的潜浮控制方法,包括以下步骤:通过安装在机器人上的传感器采集到纵倾角和垂向速度信号,将它们作为反馈信号传送给扩张状态观测器,得到纵倾角、纵倾角速率、垂向速度及系统总扰动的估计值,纵倾角和垂向速度的设定值通过跟踪微分器得到滤波后的跟踪值及其微分值。纵倾角及其微分值分别与纵倾角和纵倾角速率的估计值作差,然后输入给非线性状态误差反馈控制律,控制律的输出和扰动估计值的补偿构成了纵倾角控制量;同理,对垂向速度进行相应处理,得到垂向速度控制量。从而实现纵倾角与垂向速度完全解耦控制,达到了水下机器人以某一给定纵倾角和给定垂向速度潜浮运动的控制要求,为水下机器人完成定点垂直剖面观测提供了技术保证。 | ||
搜索关键词: | 一种 自治 水下 机器人 控制 方法 | ||
【主权项】:
一种无缆自治水下机器人的潜浮控制方法,其特征在于,包括纵倾角控制和垂向速度控制,具体包括以下步骤:通过安装在水下机器人上的传感器实时采集纵倾角和垂向速度信号;将纵倾角和垂向速度信号作为反馈信号,并结合纵倾角和垂向速度的实际控制量进行扩张状态观测,得到纵倾角、纵倾角速率、垂向速度及系统总扰动的估计值;对纵倾角和垂向速度的设定值通过跟踪微分器进行滤波,得到纵倾角的跟踪值及其微分值、垂向速度的跟踪值;将纵倾角的跟踪值及其微分值分别与纵倾角和纵倾角速率的估计值作差;将垂向速度的跟踪值与垂向速度的估计值作差;将上述差值结果进行非线性反馈控制,反馈控制结果和系统总扰动的估计值构成了纵倾角和垂向速度的控制量;纵倾角和垂向速度的控制量输入给水下机器人进行实时控制。
下载完整专利技术内容需要扣除积分,VIP会员可以免费下载。
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于中国科学院沈阳自动化研究所,未经中国科学院沈阳自动化研究所许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/patent/201410714559.0/,转载请声明来源钻瓜专利网。
- 上一篇:一种用于检测有机锡化合物的联用系统
- 下一篇:保护颈椎的睡枕及枕芯条