基于蚁群信息素仿生原理的地下复杂导航定位系统及方法

本发明涉及无人机控制，尤其是涉及一种基于蚁群信息素仿生原理的地下复杂导航定位系统及方法。

背景技术：

1、无人机(unmanned aerial vehicle，uav)是利用无线电遥控设备和自备的程序控制装置操纵的不载人飞行器。无人机用途广泛、成本低、效率较高，目前在警用、城市管理、农业、地质、气象、电力、抢险救灾、视频拍摄等行业，无人机皆有广泛的应用。

2、此外，现有技术有借助无人机，以在地下环境中进行导航定位。然而无人机通常依靠gps进行导航、定位和飞行控制，这种方式的空间探索范围受限，且由于在地下环境的原因，还可能出现信号不稳定等问题，导致实际应用中无法在地下复杂环境内实现稳定、高效、精准的导航定位。

技术实现思路

1、本发明的目的就是为了克服上述现有技术存在的缺陷而提供一种基于蚁群信息素仿生原理的地下复杂导航定位系统及方法，能够在地下复杂环境内提升空间探索范围、提高探索效率，确保实现稳定、高效、精准的导航定位。

2、本发明的目的可以通过以下技术方案来实现：一种基于蚁群信息素仿生原理的地下复杂导航定位系统，包括搭载于无人机上的控制器、飞镖发射器和多个飞镖，所述飞镖上安装有微型基站和信号发射器，所述飞镖发射器包括发射机构和信号接收器，所述信号发射器与信号接收器之间通信连接，所述微型基站用于存储当前无人机飞行路径基本信息及定位基本信息；

3、所述信号发射器用于将微型基站内存储的信息发送至信号接收器；

4、所述控制器根据信号接收器收到的信息，采用蚁群算法完成路径寻优，并相应控制无人机的飞行状态。

5、进一步地，所述微型基站内设置有zigbee芯片。

6、进一步地，所述信号发射器与信号接收器之间通过zigbee信号通信连接。

7、进一步地，所述飞镖上还安装有电池，用于提供电能给微型基站和信号发射器。

8、进一步地，所述发射机构包括发射管以及沿周向存储多个飞镖的圆盘，所述发射管内设置有弹簧，所述圆盘连接有齿轮，通过齿轮带动圆盘旋转，将飞镖依次送入发射管中，在弹簧作用下从发射管中射出。

9、一种基于蚁群信息素仿生原理的地下复杂导航定位方法，包括以下步骤：

10、s1、按照预设的前进方向，无人机在地下空间内移动、并沿途复杂环境发射飞镖；

11、s2、飞镖嵌入地下空间相应位置，同时将当前无人机飞行路径基本信息及定位基本信息存储于微型基站内；

12、s3、无人机通过信号接收器从所有已发射飞镖的信号发射器获取相应数据信息，并采用蚁群算法求解得到最优路径，相应控制无人机的飞行状态。

13、进一步地，所述步骤s2中路径基本信息及定位基本信息包括无人机所在位置信息、微型基站所在位置信息以及二者之间的信息素浓度。

14、进一步地，所述步骤s3中采用蚁群算法求解得到最优路径的具体过程为：

15、1)初始化地形矩阵、信息素矩阵、启发因子矩阵以及禁忌矩阵，其中，信息素矩阵由多个信息素浓度组合而成，启发因子为一个位置到另一个位置之间距离的倒数，禁忌矩阵为无人机已经过位置的矩阵；

16、2)结合信号接收器获取的数据信息，采用轮盘赌法求解选择下一步路径；

17、3)更新信息素矩阵以及禁忌矩阵，继续迭代求解直至达到预设的迭代次数，根据当前信息素矩阵中的信息素浓度，得到对应的导航路径，即为最优路径。

18、进一步地，所述步骤2)中采用轮盘赌法求解选择下一步路径的概率具体为：

19、

20、其中，为第k条路径的选择概率，i、j分别为无人机所在位置及微型基站所在位置，τ为当前时刻t由i到j的信息素浓度，η为路径ij长度，ψ为路径ij上的累积高度差，allowedk为无人机未访问过的路径的集合。

21、进一步地，所述步骤3)中更新信息素矩阵的公式为：

22、τij(t+1)＝τij(t)*(1-ρ)+δτij 0＜ρ＜1

23、

24、其中，ρ为信息素残留浓度系数，δτ为新增信息素含量，即为无人机在路径上留下的信息素总和，δt为无人机在ij路径上的访问次数，ι为预设的单次新增信息素量。

25、与现有技术相比，本发明具有以下优点：

26、一、本发明通过在无人机上搭载控制器、飞镖发射器和多个飞镖，并在飞镖上安装有微型基站和信号发射器、在飞镖发射器设置信号接收器，利用微型基站存储当前无人机飞行路径基本信息及定位基本信息；利用信号发射器将微型基站内存储的信息发送至信号接收器；利用控制器根据信号接收器收到的信息，采用蚁群算法完成路径寻优，并相应控制无人机的飞行状态。由此在无人机地下空间探索过程中，通过不断释放飞镖，即可实现地下非结构化环境自组网构建，利用蚁群信息素仿生原理构建专用通讯协议，基于无人机和自组网之间的信息通讯，并结合蚁群算法实现地下空间不确定条件下的复杂定位导航，不再依靠gps、也不会受gps信号条件制约，能够全程保持高效稳定地运行。

27、二、本发明中，无人机通过飞镖发射器的信号接收器，从已发射飞镖的信号发射器获取相应数据信息，使得无人机能够通过沿途飞镖实现信号中继，支持无人机集群进行地下空间探索，通过蚁群信息素仿生原理构建集群协同导航，结合蚁群算法完成路径寻优，确保导航定位的效率及准确性。

28、三、本发明在采用蚁群算法进行路径寻优时，首先初始化地形矩阵、信息素矩阵、启发因子矩阵以及禁忌矩阵，在构建路径的每一步中，采用轮盘赌法选择下一步路径，并且对信息素矩阵以及禁忌矩阵进行迭代更新，最终根据信息素矩阵中信息素浓度得到导航路径，充分保证了路径寻优的精准性。

技术特征：

1.一种基于蚁群信息素仿生原理的地下复杂导航定位系统，其特征在于，包括搭载于无人机上的控制器、飞镖发射器和多个飞镖，所述飞镖上安装有微型基站和信号发射器，所述飞镖发射器包括发射机构和信号接收器，所述信号发射器与信号接收器之间通信连接，所述微型基站用于存储当前无人机飞行路径基本信息及定位基本信息；

2.根据权利要求1所述的一种基于蚁群信息素仿生原理的地下复杂导航定位系统，其特征在于，所述微型基站内设置有zigbee芯片。

3.根据权利要求2所述的一种基于蚁群信息素仿生原理的地下复杂导航定位系统，其特征在于，所述信号发射器与信号接收器之间通过zigbee信号通信连接。

4.根据权利要求1所述的一种基于蚁群信息素仿生原理的地下复杂导航定位系统，其特征在于，所述飞镖上还安装有电池，用于提供电能给微型基站和信号发射器。

5.根据权利要求1所述的一种基于蚁群信息素仿生原理的地下复杂导航定位系统，其特征在于，所述发射机构包括发射管以及沿周向存储多个飞镖的圆盘，所述发射管内设置有弹簧，所述圆盘连接有齿轮，通过齿轮带动圆盘旋转，将飞镖依次送入发射管中，在弹簧作用下从发射管中射出。

6.一种基于蚁群信息素仿生原理的地下复杂导航定位方法，其特征在于，包括以下步骤：

7.根据权利要求6所述的一种基于蚁群信息素仿生原理的地下复杂导航定位方法，其特征在于，所述步骤s2中路径基本信息及定位基本信息包括无人机所在位置信息、微型基站所在位置信息以及二者之间的信息素浓度。

8.根据权利要求7所述的一种基于蚁群信息素仿生原理的地下复杂导航定位方法，其特征在于，所述步骤s3中采用蚁群算法求解得到最优路径的具体过程为：

9.根据权利要求8所述的一种基于蚁群信息素仿生原理的地下复杂导航定位方法，其特征在于，所述步骤2)中采用轮盘赌法求解选择下一步路径的概率具体为：

10.根据权利要求9所述的一种基于蚁群信息素仿生原理的地下复杂导航定位方法，其特征在于，所述步骤3)中更新信息素矩阵的公式为：

技术总结
本发明涉及一种基于蚁群信息素仿生原理的地下复杂导航定位系统及方法，该系统包括搭载于无人机上的控制器、飞镖发射器和多个飞镖，飞镖上安装有微型基站和信号发射器，飞镖发射器包括发射机构和信号接收器；该方法包括：按照预设的前进方向，无人机在地下空间内移动、并沿途复杂环境发射飞镖；飞镖嵌入地下空间相应位置，同时将当前无人机飞行路径基本信息及定位基本信息存储于微型基站内；无人机通过信号接收器从所有已发射飞镖的信号发射器获取相应数据信息，并采用蚁群算法求解得到最优路径，相应控制无人机的飞行状态。与现有技术相比，本发明能够在地下复杂环境内提升空间探索范围、提高探索效率，确保实现稳定、高效、精准的导航定位。

技术研发人员：何斌,李乐阳,朱忠攀,陆萍,周艳敏,王志鹏,李刚,沈润杰
受保护的技术使用者：同济大学
技术研发日：
技术公布日：2024/1/13