一种基于模糊控制算法的AUVs搜索和围捕任务分配控制方法与流程

文档序号:11153556阅读:831来源:国知局
一种基于模糊控制算法的AUVs搜索和围捕任务分配控制方法与制造工艺

本发明涉及机器人控制技术领域,具体为一种基于模糊控制算法的AUVs搜索和围捕任务分配控制方法。



背景技术:

移动目标围捕就是追捕者对移动目标进行包围,使得移动目标无路可逃,进而采取下一步行动。这就需要多追捕者之间不能是单纯的独立追捕,而是要进行协作,从而高效地完成围捕任务。这种多追捕者之间的协作在机器人学中被作为一个机器人系统,成为一个具有挑战性的关键问题,产生了很多研究成果。目前对多机器人围捕问题的研究大体可以分为两个模型基于传感器的模型和已知定位模型。在基于传感器的模型中,常见的控制方法是在未知环境中进行捕获,通过引入传感器数据的方法进行引导和控制。在已知定位模型中,逃避者的位置是已知的,通常用一些人工智能的方法。水下机器人(AUVs)也称无人遥控潜水器,是一种工作于水下的极限作业机器人。水下环境恶劣危险,人的潜水深度有限,所以水下机器人(AUVs)已成为开发海洋的重要工具。无人遥控潜水器主要有:有缆遥控潜水器和无缆遥控潜水器两种,其中有缆遥控潜水器又分为水中自航式、拖航式和能在海底结构物上爬行式三种。目前水下环境多变,很多的水下机器人在搜索围捕的时候都会遇到困难,因此设计了一种基于模糊控制算法的AUVs搜索和围捕任务分配控制方法。



技术实现要素:

针对以上问题,本发明提供了一种基于模糊控制算法的AUVs搜索和围捕任务分配控制方法,通过S型模糊神经网络实现对于水下机器人的非线性时变的动力控制,根据输入输出的样本来自动设计和调整模糊系统的设计参数,实现模糊系统的自学习和自适应功能,结合混合分层式体系结构,使得AUVs能够适应不同的复杂环境,加大了AUVs的协作效率,值得推广。

为实现上述目的,本发明提供如下技术方案:一种基于模糊控制算法的AUVs搜索和围捕任务分配控制方法,本方法采用四层模糊神经网络来实现对于AUVs的控制,所使用的模糊神经网络自上而下为输入层、模糊化层、规则层与解模糊层,对应的阶段子任务为:

(1)搜索:AUVs采用分区随机搜索方式对水下工作区域进行初步搜索,在工作的时候,根据传感器的信息进行避碰与路径规划,其中各个AUVs单独完成搜索,自主执行规划;

(2)围捕:单个AUV在工作区域中发现了规划执行目标之后,通知混合分层式体系中其他AUVs,并且第一个发现目标的AUV成为当前leader,本leader 基于成员和目标航行器的位置信息分配围捕任务,并将各子任务发布给相应的围捕成员。各成员收到任务后迅速向目标点运动,对入侵者实施围捕;

(3)避障:确定目标之后,AUV在自身行进转轮的驱动下进行接近,基于传感器感知到的障碍信息选择避碰路线,其中障碍包括静态障碍物、团队成员与敌方AUV;

(4)分散:搜索和围捕目标完成之后,自动分散AUVs回到规划执行的工作区域内,准备下一次目标的搜索和围捕。

作为本发明一种优选的技术方案,搜索策略:

某个AUV设定当前位置为(xi,yi), 搜索范围为xil≤xi≤xir,yid≤yi≤yiu,则当前的AUV随机选取搜索点(x'i,y'i)满足式子:

其中l 为一常值,表示AUV 的下一个目标点离所有AUV当前位置的最小距离不能低于此值,可以定义为工作的规划区域;

围捕策略:

H1、H2、H3、H4、H5为当前参与搜索和围捕的AUV,α表示当前目标与AUV之间的夹角,则目标运动势点坐标表示需满足式子:

然后将各个航行器按照极角从小到大排序,与势点坐标集合匹配,按序排列之后得出最优化的围捕分配方式;

避障策略:

基于蚂蚁算法,应用人工势场法,使得障碍物对AUV产生斥力,基于已有的AUV六自由度运动模型和PID 控制器。

作为本发明一种优选的技术方案,模糊神经网络中:

第一层:输入节点层,一共设置有两个节点,其中分别表示控制过程中的偏差与偏差变化率,不对信号进行任何非线性处理;

第二层:输入隶属度函数节点层,每个输入节点对应13个模糊分区,为保持水下机器人控制的多对称性,对应输入变量隶属度函数的位置;

第三层:模糊规则节点层,每一节点完成一条模糊规则的蕴含关系计算,对每一规则进行AND运算;

第四层:输出节点层,输出AUV各个行动主轴上的控制力力矩,偏差和偏差变化率的隶属度函数采用相同的分布方式。

作为本发明一种优选的技术方案,模糊神经网络中,开始加速与基于高斯函数的模糊神经网络相差不大,由于S型隶属函数自身的特征,基于S 型隶属函数的模糊神经网络必然比基于高斯型隶属函数的模糊神经网络更快地跟上速度规划器,向目标点靠近,同样由于前面分析的原因,速度一旦达到一个相对稳定的值后,则不容易随位置偏差的变化重新调整。

作为本发明一种优选的技术方案,混合分层式体系包括各个AUV内设置有任务规划层,任务规划层与行为控制层之间相互联系,行为控制层则通过传感模块接收环境信息反馈,通过控制器来控制AUV运动模型,在环境中进行移动。

与现有技术相比,本发明的有益效果是:

本发明通过S型模糊神经网络实现对于水下机器人的非线性时变的动力控制,根据输入输出的样本来自动设计和调整模糊系统的设计参数,实现模糊系统的自学习和自适应功能,结合混合分层式体系结构,使得AUVs能够适应不同的复杂环境,加大了AUVs的协作效率,值得推广。

附图说明

图1为本发明围捕过程中的任务分配示意简图;

图2为本发明模糊神经网络拓扑结构示意简图;

图3为本发明避障规划示意简图;

图4为本发明混合分层式体系结构框图。

具体实施方式

下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例仅仅是本发明一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。

实施例:

请参阅图1至图4,本发明提供一种技术方案:

本发明的一种基于模糊控制算法的AUVs搜索和围捕任务分配控制方法,本方法采用四层模糊神经网络来实现对于AUVs的控制,所使用的模糊神经网络自上而下为输入层、模糊化层、规则层与解模糊层,对应的阶段子任务为:

(1)搜索:AUVs采用分区随机搜索方式对水下工作区域进行初步搜索,在工作的时候,根据传感器的信息进行避碰与路径规划,其中各个AUVs单独完成搜索,自主执行规划;

(2)围捕:单个AUV在工作区域中发现了规划执行目标P之后,通知混合分层式体系中其他AUVs,并且第一个发现目标的AUV成为当前leader,本leader 基于成员和目标航行器的位置信息分配围捕任务,并将各子任务发布给相应的围捕成员H n(n=1.2.3.4.5……)。各成员收到任务后迅速向目标点Tn(n=1.2.3.4.5……)运动,对入侵者实施围捕;

(3)避障:确定目标之后,AUV在自身行进转轮的驱动下进行接近,基于传感器感知到的障碍信息选择避碰路线,其中障碍包括静态障碍物、团队成员与敌方AUV;

(4)分散:搜索和围捕目标完成之后,自动分散AUVs回到规划执行的工作区域内,准备下一次目标的搜索和围捕。

其中,搜索策略:

某个AUV设定当前位置为(xi,yi),搜索范围为xil≤xi≤xir ,yid≤yi≤yiu,则当前的AUV随机选取搜索点(x'i,y'i)满足式子:

其中l 为一常值,表示AUV 的下一个目标点离所有AUV 当前位置的最小距离不能低于此值,可以定义为工作的规划区域;

围捕策略:

H1、H2、H3、H4、H5为当前参与搜索和围捕的AUV,α表示当前目标与AUV之间的夹角,则目标运动势点坐标表示需满足式子:

然后将各个航行器按照极角从小到大排序,与势点坐标集合匹配,按序排列之后得出最优化的围捕分配方式;

避障策略:

基于蚂蚁算法,应用人工势场法,使得障碍物对AUV产生斥力,基于已有的AUV六自由度运动模型和PID控制器。

模糊神经网络中:

第一层:输入节点层,一共设置有两个节点,其中分别表示控制过程中的偏差与偏差变化率,不对信号进行任何非线性处理;

第二层:输入隶属度函数节点层,每个输入节点对应13个模糊分区,为保持水下机器人控制的多对称性,对应输入变量隶属度函数的位置;

第三层:模糊规则节点层,每一节点完成一条模糊规则的蕴含关系计算,对每一规则进行AND运算;

第四层:输出节点层,输出AUV各个行动主轴上的控制力力矩,偏差和偏差变化率的隶属度函数采用相同的分布方式。

模糊神经网络中,开始加速与基于高斯函数的模糊神经网络相差不大,由于S型隶属函数自身的特征,基于S型隶属函数的模糊神经网络必然比基于高斯型隶属函数的模糊神经网络更快地跟上速度规划器,向目标点靠近,同样由于前面分析的原因,速度一旦达到一个相对稳定的值后,则不容易随位置偏差的变化重新调整。

混合分层式体系包括各个AUV内设置有任务规划层,任务规划层与行为控制层之间相互联系,行为控制层则通过传感模块接收环境信息反馈,通过控制器来控制AUV运动模型,在环境中进行移动。

本发明通过S型模糊神经网络实现对于水下机器人的非线性时变的动力控制,根据输入输出的样本来自动设计和调整模糊系统的设计参数,实现模糊系统的自学习和自适应功能,结合混合分层式体系结构,使得AUVs能够适应不同的复杂环境,加大了AUVs的协作效率,值得推广。

以上所述仅为本发明的较佳实施例而已,并不用以限制本发明,凡在本发明的精神和原则之内所作的任何修改、等同替换和改进等,均应包含在本发明的保护范围之内。

当前第1页1 2 3 
网友询问留言 已有0条留言
  • 还没有人留言评论。精彩留言会获得点赞!
1