【技术实现步骤摘要】
本专利技术属于微小型无人机集群协同控制，具体涉及一种微小型多旋翼无人机集群协同控制系统。
技术介绍
1、无人机是指利用无线电遥控设备、自备的程序控制装置或者由机载计算机完全地、间歇地自主操作的不载人飞机。随着无人机功能的不断发展，其无人化、智能化、低成本等优势，使得无人机在多个领域大显身手。同时，无人机的任务也逐渐多样化和复杂化，从低级使用逐步进化为高阶运用，从单体转向多机编队协同任务，愈发体现出其任务完成率较高、任务完成速度较快、信息感知量较大等优势。而对于这些协同任务而言，无人机的自主轨迹规划能力和协同飞行能力是无人机协同控制系统能够完成飞行任务的必要条件。
2、文献(crazyswarm:a large nano-quadcopter swarm[c]//2017ieeeinternational conference on robotics and automation(icra).ieee,2017:3299-3304.)设计的crazyflie四旋翼无人机平台是当今使用较为广泛的一款四旋翼多机协同控制平台。该平台使用尺寸小、重量轻的超轻型四旋翼无人机，使用自主研发的飞控与通信系统，为各类无人机控制实验提供了上位机接口，能够较好满足实验需求。但由于无人机的体积小而引发的动力储备不足、续航时间较短、大机动飞行动作受限、平台延展性不良等问题也对相关实验产生了巨大的限制，导致平台在协同控制上的扩展性较差。
3、文献(fast,autonomous flight in gps-denied and cl
4、文献(agilicious:open-source and open-hardware agile quadrotor forvision-based flight[j].science robotics,2022,7(67):eabl6259.)提出的agilicious平台采用了穿越机方案，使用中型尺寸机架并结合自研飞控与四合一电调形成飞塔，以减小空间占用。该平台有着较高的飞行机动能力，其搭载的机载电脑也提供了较高的算力资源，但单机成本过高，不适用于需要大规模部署的协同控制实验，亦无可靠的多机通信功能提供通信保障。
技术实现思路
1、本专利技术的目的是为解决基于现有平台的控制系统无法提供可靠的多机通信功能以及无法实现稳定的大规模多机协同控制的问题，而提出了一种微小型多旋翼无人机集群协同控制系统。
2、本专利技术为解决上述技术问题所采取的技术方案是：一种微小型多旋翼无人机集群协同控制系统，所述系统包括微小型多旋翼无人机协同模块、通信模块和多功能地面模块，且多功能地面模块内包括第二代机器人操作单元、无人机位姿获取单元、期望指令获取单元和交互单元，其中：
3、所述微小型多旋翼无人机协同模块用于获取各个微小型多旋翼无人机的传感器数据，并将获取的传感器数据发送给通信模块；
4、所述通信模块将传感器数据发送给第二代机器人操作单元；
5、无人机位姿获取单元用于获取各个微小型多旋翼无人机的位姿数据，并将获取的位姿数据发送给第二代机器人操作单元；
6、第二代机器人操作单元将包含无人机传感器和位姿数据的状态数据发送给期望指令获取单元和交互单元；
7、交互单元用于根据接收的无人机状态数据输出控制指令，并将控制指令发送给第二代机器人操作单元；
8、期望指令获取单元用于根据接收的无人机状态数据输出期望指令，并将期望指令发送给第二代机器人操作单元；
9、第二代机器人操作单元将控制指令和期望指令发送给通信模块，通信模块将控制指令和期望指令发送给微小型多旋翼无人机协同模块；
10、微小型多旋翼无人机协同模块用于根据接收的控制指令、期望指令和各微小型多旋翼无人机间的通信关系进行任务规划和轨迹规划。
11、进一步地，所述微小型多旋翼无人机设计了pcb一体式机身，在机身的制备材料中加入了复合pla材料，在电机与传感器之间设置有软性橡胶，电机的驱动系统基于单通道下桥臂设计。
12、进一步地，所述微小型多旋翼无人机上设置有imu、指南针、气压传感器、激光定高传感器和光流传感器。
13、进一步地，所述微小型多旋翼无人机协同模块基于无人机飞控核心进行任务规划和轨迹规划，无人机飞控核心以stm32f405作为处理器。
14、进一步地，所述微小型多旋翼无人机上还设置有存储器，所述存储器包括fm25v01fram存储器和mkdv4gcl sd nand存储器，fm25v01 fram存储器和mkdv4gcl sdnand存储器用于存储无人机飞行参数、飞行日志和自定义脚本文件；
15、无人机飞控核心、存储器和传感器数据采用i2c或spi总线与通信模块进行通信。
16、进一步地，所述微小型多旋翼无人机的电源部分采用多级管理方案，即支持宽压输入，交错分离不同区间的电源域。
17、进一步地，所述通信模块包括天空端、地面端和路由端；
18、天空端用于接收多旋翼无人机的传感器数据，并将传感器数据通过udp广播至指定端口，再经过iot设备完成天空端与地面端的通信；
19、通过地面端将传感器数据发送给第二代机器人操作单元；
20、路由端用于管理多旋翼无人机和多功能地面模块的局域网连接。
21、进一步地，所述无人机位姿获取单元的工作过程为：
22、以任意一架微小型多旋翼无人机为例
23、步骤1、将微小型多旋翼无人机的初始位置记为t0，将微小型多旋翼无人机初始的标识点排列方式记为p＝{p1,p2,p3,....,pn}，其中，p1,p2,p3,....,pn是微小型多旋翼无人机上各标识点的位置，n是标识点个数，采用迭代最近点算法，并结合t0和p确定出微小型多旋翼无人机的初始位姿r0；
24、步骤2、将初始位置的图像作为第一帧图像，则微小型多旋翼无人机运动后，将第二帧图像中标识点排列方式记为q＝{q1,q2,q3,....,qn}，q1,q2,q3,....,qn是微小型多旋翼无人机上各标识点在第二帧图像中的位置，根据p＝{p1,p2,p3,....,pn}和q＝{q1,q2,q3,....,qn}计算第二帧图像中的微小型多旋翼无人机相当于第一帧图像中的微小型多旋翼无人机的旋转矩阵r和平移矩阵t；
25、步骤3、根据初始位姿r0、旋转矩阵r和平移矩阵t获得微小型多旋翼无人本文档来自技高网...
【技术保护点】
1.一种微小型多旋翼无人机集群协同控制系统，其特征在于，所述系统包括微小型多旋翼无人机协同模块、通信模块和多功能地面模块，且多功能地面模块内包括第二代机器人操作单元、无人机位姿获取单元、期望指令获取单元和交互单元，其中：
2.根据权利要求1所述的一种微小型多旋翼无人机集群协同控制系统，其特征在于，所述微小型多旋翼无人机设计了PCB一体式机身，在机身的制备材料中加入了复合PLA材料，在电机与传感器之间设置有软性橡胶，电机的驱动系统基于单通道下桥臂设计。
3.根据权利要求2所述的一种微小型多旋翼无人机集群协同控制系统，其特征在于，所述微小型多旋翼无人机上设置有IMU、指南针、气压传感器、激光定高传感器和光流传感器。
4.根据权利要求3所述的一种微小型多旋翼无人机集群协同控制系统，其特征在于，所述微小型多旋翼无人机协同模块基于无人机飞控核心进行任务规划和轨迹规划，无人机飞控核心以STM32F405作为处理器。
5.根据权利要求4所述的一种微小型多旋翼无人机集群协同控制系统，其特征在于，所述微小型多旋翼无人机上还设置有存储器，所述存储器包括
6.根据权利要求5所述的一种微小型多旋翼无人机集群协同控制系统，其特征在于，所述微小型多旋翼无人机的电源部分采用多级管理方案，即支持宽压输入，交错分离不同区间的电源域。
7.根据权利要求6所述的一种微小型多旋翼无人机集群协同控制系统，其特征在于，所述通信模块包括天空端、地面端和路由端；
8.根据权利要求7所述的一种微小型多旋翼无人机集群协同控制系统，其特征在于，所述无人机位姿获取单元的工作过程为：
9.根据权利要求8所述的一种微小型多旋翼无人机集群协同控制系统，其特征在于，所述步骤2的具体过程为：
10.根据权利要求9所述的一种微小型多旋翼无人机集群协同控制系统，其特征在于，所述任务规划和轨迹规划描述为：
...【技术特征摘要】
1.一种微小型多旋翼无人机集群协同控制系统，其特征在于，所述系统包括微小型多旋翼无人机协同模块、通信模块和多功能地面模块，且多功能地面模块内包括第二代机器人操作单元、无人机位姿获取单元、期望指令获取单元和交互单元，其中：
2.根据权利要求1所述的一种微小型多旋翼无人机集群协同控制系统，其特征在于，所述微小型多旋翼无人机设计了pcb一体式机身，在机身的制备材料中加入了复合pla材料，在电机与传感器之间设置有软性橡胶，电机的驱动系统基于单通道下桥臂设计。
3.根据权利要求2所述的一种微小型多旋翼无人机集群协同控制系统，其特征在于，所述微小型多旋翼无人机上设置有imu、指南针、气压传感器、激光定高传感器和光流传感器。
4.根据权利要求3所述的一种微小型多旋翼无人机集群协同控制系统，其特征在于，所述微小型多旋翼无人机协同模块基于无人机飞控核心进行任务规划和轨迹规划，无人机飞控核心以stm32f405作为处理器。
5.根据权利要求4所述的一种微小型多旋翼无人机集群协同控制系统，其...
【专利技术属性】
技术研发人员：刘博，贺天辰，范熙宇，杨舜元，宋迪，吴琬莹，
申请(专利权)人：黑龙江笛卡尔科技有限公司，
类型：发明
国别省市：
还没有人留言评论。发表了对其他浏览者有用的留言会获得科技券。