| 发明名称 |
基于模糊自适应观测器的欠驱动水面艇轨迹跟踪控制系统 |
| 摘要 |
本发明公开了一种基于模糊自适应观测器的欠驱动水面艇轨迹跟踪控制系统。传感器模块采集水面艇的位置及航向信息y，输出给模糊自适应观测器；模糊自适应观测器接收控制器的输出，得到位置与艏向估计<img file="DDA0000523977480000011.GIF" wi="62" he="60" />速度估计<img file="DDA0000523977480000012.GIF" wi="59" he="52" />慢变扰动力估计<img file="DDA0000523977480000013.GIF" wi="46" he="74" />和未知非线性项估计<img file="DDA0000523977480000014.GIF" wi="79" he="86" />分别传送给轨迹跟踪误差生成器和控制器；导引系统解算得到船体坐标系下期望速度及加速度信息，分别传送给轨迹跟踪误差生成器和控制器；轨迹跟踪误差生成器得到轨迹跟踪各状态误差信息，传送给控制器；控制器计算出当前时刻的纵向推力和转艏力矩控制指令，传递给推力系统，推力系统执行控制指令。本发明能够仅有位置和艏向角可测且模型存在不确定性的情况下，能够实现快速跟踪。 |
| 申请公布号 |
CN104076821B |
申请公布日期 |
2017.01.04 |
| 申请号 |
CN201410276571.8 |
申请日期 |
2014.06.19 |
| 申请人 |
哈尔滨工程大学 |
发明人 |
夏国清;王国庆;赵昂 |
| 分类号 |
G05D1/12(2006.01)I;G05D1/02(2006.01)I;G05B13/04(2006.01)I |
主分类号 |
G05D1/12(2006.01)I |
| 代理机构 |
|
代理人 |
|
| 主权项 |
基于模糊自适应观测器的欠驱动水面艇轨迹跟踪控制系统，其特征在于：包括传感器模块(6)、模糊自适应观测器(7)、导引系统(23)、轨迹跟踪误差生成器(24)、控制器(18)、推进系统(3)，导引系统(23)根据已知惯性坐标系下期望轨迹的位置信号，经过坐标变换解算得到船体坐标系下期望速度及加速度信息，分别传送给轨迹跟踪误差生成器(24)和控制器(18)；轨迹跟踪误差生成器(24)接收的模糊自适应观测器(7)输出的位置与艏向估计<img file="FDA0001061464060000011.GIF" wi="63" he="62" />速度估计<img file="FDA0001061464060000012.GIF" wi="50" he="47" />并与接收的期望速度及加速度信息对比得到轨迹跟踪各状态误差信息，传送给控制器(18)；控制器(18)还接收模糊自适应观测器(7)输出的位置与艏向估计<img file="FDA0001061464060000013.GIF" wi="67" he="55" />速度估计<img file="FDA0001061464060000014.GIF" wi="56" he="47" />慢变扰动力估计<img file="FDA0001061464060000015.GIF" wi="34" he="63" />和未知非线性项估计<img file="FDA0001061464060000016.GIF" wi="67" he="75" />并且控制器(18)根据接收的信息解算出纵向推力和转艏力矩控制指令，传递给模糊自适应观测器(7)和推进系统(3)，推进系统(3)执行控制指令；传感器模块(6)采集推进系统(3)执行控制指令后的水面艇的位置及航向信息y，输出给模糊自适应观测器(7)；模糊自适应观测器(7)根据接收的纵向推力和转艏力矩控制指令，结合传感器模块输出的位置和航向信息y，得到位置与艏向估计<img file="FDA0001061464060000017.GIF" wi="62" he="59" />速度估计<img file="FDA0001061464060000018.GIF" wi="58" he="47" />慢变扰动力估计<img file="FDA0001061464060000019.GIF" wi="37" he="63" />和未知非线性项估计<img file="FDA00010614640600000110.GIF" wi="62" he="70" />分别传送给轨迹跟踪误差生成器(24)和控制器(18)；所述的控制器(18)包括虚拟控制律模块(19)、轨迹跟踪滑膜控制模块(20)，虚拟控制律模块(19)接收期望速度及加速度信息和轨迹跟踪各状态误差信息，得到虚拟纵向跟踪速度和虚拟横向跟踪速度，传送给轨迹跟踪滑膜控制模块(20)；轨迹跟踪滑膜控制模块(20)根据接收到的虚拟纵向跟踪速度和虚拟横向跟踪速度、位置与艏向估计<img file="FDA00010614640600000111.GIF" wi="61" he="56" />速度估计<img file="FDA00010614640600000112.GIF" wi="51" he="50" />慢变扰动力估计<img file="FDA00010614640600000113.GIF" wi="35" he="63" />和未知非线性项估计<img file="FDA00010614640600000114.GIF" wi="67" he="69" />解算出纵向推力和转艏力矩控制指令，传送给推进系统。 |
| 地址 |
150001 黑龙江省哈尔滨市南岗区南通大街145号哈尔滨工程大学科技处知识产权办公室 |
