1.一种基于领导‑追随模型的多无人船系统协同控制方法,其特征在于,包括:无人船运动模型获取步骤,建立三自由度无人船水平面运动数学模型;
初步离散避障角度获取步骤,基于领导‑追随模型的多无人船的初始连通关系确定领导者无人船、追随者无人船及船载传感器捕获的障碍物任二者之间的相对位姿关系,基于所述相对位姿关系建立初步离散避障角度模型 并得到初步避障角度 ,所述初步离散避障角度模型 表示为如下计算模型:,
其中,初步避障角度 表示为如下计算模型:;
光滑避障角度获取步骤,利用双曲正切函数将初步离散避障角度模型 拟合为平滑避障模型 后对平滑避障模型 与期望相对角度 进行光滑处理得到光滑避障角度,将所述光滑避障角度 作为下一时刻的期望角度通过控制器控制追随者无人船避障,所述光滑避障角度 表示为如下计算模型:,
其中,
,
, , 、 是
大于0的常数, 表示领导者无人船的艏摇角, 为追随者无人船与障碍物之间的相对距离, 为领导者无人船与障碍物之间的相对距离, 表示期望相对距离, 表示避障半径, 为期望相对角度, 为追随者无人船与障碍物之间的相对角度, 为领导者无人船与障碍物之间的相对角度;
误差性能函数获取步骤,基于多无人船系统的中领导者无人船及多个追随者无人船的位置信息及艏摇角确定编队误差及速度误差,定义误差性能函数并基于所述编队误差及速度误差对所述误差性能函数进行约束,误差表示为如下计算模型:,
,
,
上述模型中, , ,误差性能函数包括连通性保持性能函数 、平滑避障性能函数 及编队协同性能函数 、 ,所述连通性保持性能函数 、平滑避障性能函数 及编队协同性能函数 、 分别表示为如下计算模型:上述模型中, , , 为无人船开始运动的时间, 为无人船稳定的时间, , 是正常数;
追随者编队控制步骤,将误差性能函数中误差 、 、 通过对数函数引入控制器中,生成追随者控制策略,所述追随者控制策略中包括更新后的理想纵荡速度 、理想横荡速度 、理想艏摇角速度 、纵荡方向推力 、艏摇方向推力 及辅助信号 ,表示为如下计算模型:,
上述模型中, , , ,
, , , , 为追随者艏摇角, 为领导者无人船与追随者无人船之间的相对角度, 为配置的辅助信号,用于稳定横荡速度在有限范围内;
所述误差性能函数获取步骤中,所述编队误差为领导者无人船与追随者无人船之间的相对距离 、相对角度 及追随者艏摇角 分别与期望相对距离 、光滑避障角度及一接近角 的差值,分别记为编队相对距离误差 、编队相对角度误差 、追随者艏摇角误差 ,所述接近角 为模拟追随者对应位姿的期望艏摇角;
其中,所述编队相对距离误差 、编队相对角度误差 、追随者艏摇角误差 表示为如下计算模型:上式中:
其中, 是大于0的常数;
所述误差性能函数获取步骤中,所述速度误差为追随者无人船在目标时刻的纵荡速度、横荡速度 、艏摇角速度 与预设的理想纵荡速度 、理想横荡速度 、理想艏摇角速度 之间的差值,分别记为纵荡速度误差 、横荡速度误差 、艏摇角速度误差,纵荡速度误差 、横荡速度误差 、艏摇角速度误差 表示为如下计算模型:,
,
。
2.根据权利要求1所述的基于领导‑追随模型的多无人船系统协同控制方法,其特征在于,所述连通性保持性能函数 、平滑避障性能函数 及编队协同性能函数 、 的约束条件配置如下:,
,
,
,
,
,
其中, 是无人船通讯范围, 为最小避障范围。
3.根据权利要求1所述的基于领导‑追随模型的多无人船系统协同控制方法,其特征在于,领导者无人船与追随者无人船之间的相对位姿关系表示为如下计算模型;
,
上式中, 、 为领导者无人船的位置信息, 、 为追随者无人船的位置信息, 为领导者无人船与追随者无人船之间的相对距离, 为领导者无人船与追随者无人船之间的相对角度。
4.根据权利要求3所述的基于领导‑追随模型的多无人船系统协同控制方法,其特征在于,领导者无人船与障碍物之间的相对位姿关系表示为如下计算模型:,
上式中, 、 为障碍物的位置信息;追随者无人船与障碍物之间的相对位姿关系表示为如下计算模型:。
5.一种基于领导‑追随模型的多无人船系统协同控制系统,用于实现如权利要求1至4中任一项所述的基于领导‑追随模型的多无人船系统协同控制方法,其特征在于,包括:无人船运动模型获取单元,用于建立三自由度无人船水平面运动数学模型;
初步离散避障角度获取单元,用于基于领导‑追随模型的多无人船的初始连通关系确定领导者无人船、追随者无人船及船载传感器捕获的障碍物任二者之间的相对位姿关系,基于所述相对位姿关系建立初步离散避障角度模型 并得到初步避障角度 ;
光滑避障角度获取单元,用于利用双曲正切函数将初步离散避障角度模型 拟合为平滑避障模型 后对平滑避障模型 与期望相对角度 进行光滑处理得到光滑避障角度 ,将所述光滑避障角度 作为下一时刻的期望角度通过控制器控制追随者无人船避障;
误差性能函数获取单元,用于基于多无人船系统的中领导者无人船及多个追随者无人船的位置信息及艏摇角确定编队误差及速度误差,定义误差性能函数并基于所述编队误差及速度误差对所述误差性能函数进行约束;
追随者编队控制单元,用于将误差性能函数中误差 、 、 通过对数函数引入控制器中,生成追随者控制策略。