一种避免微分爆炸的UUV轨迹跟踪控制方法

    公开(公告)号:CN107024863B

    公开(公告)日:2020-01-17

    申请号:CN201710184342.7

    申请日:2017-03-24

    Abstract: 本发明利用生物启发模型的微分输出特性,提供一种避免微分爆炸的UUV轨迹跟踪控制方法。包括以下步骤:步骤1:初始化;步骤2:利用欠驱动UUV的数学模型得出位置、姿态误差变量;步骤3:计算虚拟控制律,并利用生物启发模型输出值代替虚拟期望控制律;步骤4:构造Lyapunov函数将位置误差的镇定转移到对速度误差的镇定上,利用生物启发模型输出代替虚拟控制量的实时求导避免微分爆炸现象,实现速度误差的镇定;步骤5:设计轨迹跟踪控制器。本发明方法能够避免传统反步法中由反复求导导致的微分爆炸现象,简化控制器的复杂性;同时,结合生物启发模型的控制器满足推进器的推力约束和欠驱动UUV三维轨迹跟踪对位置、速度以及姿态的时间约束要求。

    基于辅助推进器的UUV水下定点回转探测方法及控制系统

    公开(公告)号:CN106843241A

    公开(公告)日:2017-06-13

    申请号:CN201710085964.4

    申请日:2017-02-17

    CPC classification number: G05D1/0692

    Abstract: 本发明提供的是一种基于辅助推进器的UUV水下定点回转探测方法及控制系统。UUV自主航行至待探测水域上方就位,开启垂直辅助推进器做定点下潜;实时监测UUV高度,若没有触底危险则继续下潜至指定深度,调用定点悬停算法进行定点悬停,若有触底危险则停止下潜直接定点悬停;开启前视声纳,采集前方可测范围内的环境信息;下达定点回转指令,通过定点回转算法对艏、艉水平辅助推进器进行推力分配,使UUV以转艏角速度做匀速定点回转,直到完成回转次数;完成探测任务,准备执行下一任务。本发明避免了传统巡游方式探测地形的局限,并解决了利用主推进器驱动无法实现定点的问题,实现了UUV高效、隐蔽、无死区的地形探测。

    一种基于动态速度调节的欠驱动UUV平面轨迹跟踪控制方法

    公开(公告)号:CN105929842A

    公开(公告)日:2016-09-07

    申请号:CN201610247753.1

    申请日:2016-04-20

    CPC classification number: G05D1/10 G05D1/0808

    Abstract: 一种基于动态速度调节的欠驱动UUV平面轨迹跟踪控制方法,涉及欠驱动水下无人航行器的运动控制技术。本发明是为了实现欠驱动UUV平面轨迹的精确跟踪控制。包括以下步骤:步骤一:UUV根据当前任务获取位置、姿态信息;步骤二:利用欠驱动UUV的数学模型得出位置、姿态误差变量;步骤三:采用定义虚拟速度误差变量的方法,计算出虚拟控制律;步骤四:结合生物启发模型对速度误差进行动态调节;步骤五:推导出动态速度调节控制器产生的控制信号,实现欠驱动UUV平面轨迹跟踪控制。本发明方法能够对欠驱动UUV的速度进行动态调节,同时避免了传统反步法中首向角误差等于90°时的奇异值,实现了在外界常值扰动下对圆形轨迹的跟踪。

    基于生物速度调节的欠驱动AUV三维轨迹跟踪控制方法

    公开(公告)号:CN106444806B

    公开(公告)日:2019-03-05

    申请号:CN201610854361.1

    申请日:2016-09-27

    Abstract: 本发明提供的是一种基于生物速度调节的欠驱动AUV三维轨迹跟踪控制方法。包括以下步骤:步骤1:AUV根据当前任务给定期望轨迹位置信息并获取当前的位置、姿态信息;步骤2:利用欠驱动UUV的数学模型得出位置、姿态误差变量;步骤3:采用定义虚拟速度误差变量的方法,计算出虚拟控制律;步骤4:通过生物启发模型完成对速度误差进行动态调节;步骤5:推导动态速度调节控制器。本发明方法能够对欠驱动AUV的速度误差进行动态调节,同时在避免传统反步法中艏向角误差等于90°时奇异值的同时,提高了控制器的性能,实现了在外界常值扰动下对时变三维轨迹的精确跟踪。

    一种基于动态速度调节的欠驱动UUV平面轨迹跟踪控制方法

    公开(公告)号:CN105929842B

    公开(公告)日:2019-01-11

    申请号:CN201610247753.1

    申请日:2016-04-20

    Abstract: 一种基于动态速度调节的欠驱动UUV平面轨迹跟踪控制方法,涉及欠驱动水下无人航行器的运动控制技术。本发明是为了实现欠驱动UUV平面轨迹的精确跟踪控制。包括以下步骤:步骤一:UUV根据当前任务获取位置、姿态信息;步骤二:利用欠驱动UUV的数学模型得出位置、姿态误差变量;步骤三:采用定义虚拟速度误差变量的方法,计算出虚拟控制律;步骤四:结合生物启发模型对速度误差进行动态调节;步骤五:推导出动态速度调节控制器产生的控制信号,实现欠驱动UUV平面轨迹跟踪控制。本发明方法能够对欠驱动UUV的速度进行动态调节,同时避免了传统反步法中首向角误差等于90°时的奇异值,实现了在外界常值扰动下对圆形轨迹的跟踪。

    浮力均衡装置辅助的UUV主动坐底方法

    公开(公告)号:CN105549602B

    公开(公告)日:2018-11-06

    申请号:CN201610084872.X

    申请日:2016-02-06

    Abstract: 浮力均衡装置辅助的UUV主动坐底方法,涉及一种UUV控制领域,是为了在UUV坐底时,克服测高声纳盲区和推进器近壁面效应,及保持静默状态。本发明所涉及的一种浮力均衡装置辅助的UUV主动坐底方法,用于航行器在执行主动坐底任务时,提前建立航行器的任务模块,利用测量单元以及先验知识库,选择适当的时机切换辅助推进器和浮力均衡装置,完成主动坐底并保持静默状态的调节方法。该方法增加了UUV的智能性,通过切换辅助推进器和浮力均衡装置,有效的克服了测高声纳测量高度具有盲区所导致测高无效的缺陷,在保持主动坐底精度的同时满足了静默坐底的隐蔽工况。本发明适用于UUV主动坐底场合。

    基于生物速度调节的欠驱动AUV三维轨迹跟踪控制方法

    公开(公告)号:CN106444806A

    公开(公告)日:2017-02-22

    申请号:CN201610854361.1

    申请日:2016-09-27

    CPC classification number: G05D1/0875

    Abstract: 本发明提供的是一种基于生物速度调节的欠驱动AUV三维轨迹跟踪控制方法。包括以下步骤:步骤1:AUV根据当前任务给定期望轨迹位置信息并获取当前的位置、姿态信息;步骤2:利用欠驱动UUV的数学模型得出位置、姿态误差变量;步骤3:采用定义虚拟速度误差变量的方法,计算出虚拟控制律;步骤4:通过生物启发模型完成对速度误差进行动态调节;步骤5:推导动态速度调节控制器。本发明方法能够对欠驱动AUV的速度误差进行动态调节,同时在避免传统反步法中艏向角误差等于90°时奇异值的同时,提高了控制器的性能,实现了在外界常值扰动下对时变三维轨迹的精确跟踪。

    一种避免微分爆炸的UUV轨迹跟踪控制方法

    公开(公告)号:CN107024863A

    公开(公告)日:2017-08-08

    申请号:CN201710184342.7

    申请日:2017-03-24

    Abstract: 本发明利用生物启发模型的微分输出特性,提供一种避免微分爆炸的UUV轨迹跟踪控制方法。包括以下步骤:步骤1:初始化;步骤2:利用欠驱动UUV的数学模型得出位置、姿态误差变量;步骤3:计算虚拟控制律,并利用生物启发模型输出值代替虚拟期望控制律;步骤4:构造Lyapunov函数将位置误差的镇定转移到对速度误差的镇定上,利用生物启发模型输出代替虚拟控制量的实时求导避免微分爆炸现象,实现速度误差的镇定;步骤5:设计轨迹跟踪控制器。本发明方法能够避免传统反步法中由反复求导导致的微分爆炸现象,简化控制器的复杂性;同时,结合生物启发模型的控制器满足推进器的推力约束和欠驱动UUV三维轨迹跟踪对位置、速度以及姿态的时间约束要求。

    浮力均衡装置辅助的UUV主动坐底方法

    公开(公告)号:CN105549602A

    公开(公告)日:2016-05-04

    申请号:CN201610084872.X

    申请日:2016-02-06

    CPC classification number: G05D1/0692

    Abstract: 浮力均衡装置辅助的UUV主动坐底方法,涉及一种UUV控制领域,是为了在UUV坐底时,克服测高声纳盲区和推进器近壁面效应,及保持静默状态。本发明所涉及的一种浮力均衡装置辅助的UUV主动坐底方法,用于航行器在执行主动坐底任务时,提前建立航行器的任务模块,利用测量单元以及先验知识库,选择适当的时机切换辅助推进器和浮力均衡装置,完成主动坐底并保持静默状态的调节方法。该方法增加了UUV的智能性,通过切换辅助推进器和浮力均衡装置,有效的克服了测高声纳测量高度具有盲区所导致测高无效的缺陷,在保持主动坐底精度的同时满足了静默坐底的隐蔽工况。本发明适用于UUV主动坐底场合。

Patent Agency Ranking