买专利卖专利找龙图腾，真高效！ 查专利查商标用IPTOP,全免费！专利年费监控用IP管家,真方便！

申请/专利权人：山东科技大学

摘要：本申请涉及无人船控制技术领域，特别是涉及基于领导‑追随模型的多无人船系统协同控制方法及系统，该方法包括：建立三自由度无人船水平面运动数学模型，基于领导‑追随模型的多无人船的初始连通关系确定领导者无人船、追随者无人船及障碍物任二者之间的相对位姿关系，基于相对位姿关系建立初步离散避障角度模型并得到初步避障角度，将初步离散避障角度模型拟合为平滑避障模型后对平滑避障模型与期望相对角度进行光滑处理得到光滑避障角度，基于所述编队误差及速度误差对误差性能函数进行约束，基于该误差函数生成追随者控制策略。通过本申请保证多无人船在有限通讯范围实现队形维持和避障，降低无人船因避障而断联的风险。

主权项：1.一种基于领导-追随模型的多无人船系统协同控制方法，其特征在于，包括：无人船运动模型获取步骤，建立三自由度无人船水平面运动数学模型；初步离散避障角度获取步骤，基于领导-追随模型的多无人船的初始连通关系确定领导者无人船、追随者无人船及船载传感器捕获的障碍物任二者之间的相对位姿关系，基于所述相对位姿关系建立初步离散避障角度模型并得到初步避障角度；光滑避障角度获取步骤，利用双曲正切函数将初步离散避障角度模型拟合为平滑避障模型后对平滑避障模型与期望相对角度进行光滑处理得到光滑避障角度，将所述光滑避障角度作为下一时刻的期望角度通过控制器控制追随者无人船避障，所述光滑避障角度表示为如下计算模型： +，其中，++，，，、是大于0的常数，表示领导者无人船的艏摇角，为追随者无人船与障碍物之间的相对距离，为领导者无人船与障碍物之间的相对距离，表示期望相对距离，表示避障半径，为期望相对角度，为追随者无人船与障碍物之间的相对角度，为领导者无人船与障碍物之间的相对角度；误差性能函数获取步骤，基于多无人船系统的中领导者无人船及多个追随者无人船的位置信息及艏摇角确定编队误差及速度误差，定义误差性能函数并基于所述编队误差及速度误差对所述误差性能函数进行约束；追随者编队控制步骤，将误差性能函数中误差通过对数函数引入控制器中，生成追随者控制策略，所述追随者控制策略中包括更新后的理想纵荡速度、理想横荡速度、理想艏摇角速度、纵荡方向推力、艏摇方向推力及辅助信号，表示为如下计算模型： ，其中，，，n=1、2、3，p=4、5、6，0，v=1,…,6，0，为追随者艏摇角，为领导者无人船与追随者无人船之间的相对角度，为配置的辅助信号，用于稳定横荡速度在有限范围内。

全文数据：

权利要求：

百度查询： 山东科技大学 基于领导-追随模型的多无人船系统协同控制方法及系统