基于雁阵变换的微型扑翼飞行机器人集群行为控制方法.pdf

第6 卷第3期2023年6 月引用格式】丁伟，张峰，宋敏，等.基于雁阵变换的微型扑翼飞行机器人集群行为控制方法J.无人系统技术，2 0 2 3,6(3)：1 2 9-1 43.无人系统技术Unmanned Systems TechnologyVol.6No.3June 2023基于雁阵变换的微型扑翼飞行机器人集群行为控制方法丁伟，张长峰2，宋敏，崔龙，王宏伟，刘钊铭，缪磊（1.沈阳工程学院自动化学院，沈阳1 1 0 1 36；2.中国科学院沈阳自动化研究所机器人学国家重点实验室，沈阳1 1 0 1 6 9）摘要：为了解决微型扑翼飞行机器人集群编队目标搜索覆盖效率、避障通过性和多机控制等难题，实现扑翼飞行机器人集群编队的智能控制，提出了基于雁阵变换的扑翼飞行机器人集群行为控制方法。利用仿生集群行为控制函数的参数化特性，实现了飞行机器人编队的队形变换和角度控制；搭建了多扑翼飞行机器人实验系统，并在多种情况下设计基于仿生行为的多扑翼飞行机器人集群控制方法实验。最终的实验结果验证了方法的可行性和有效性。与传统的多飞行机器人实时控制方法相比，所提方法大幅提升了集群编队的搜索覆盖效率和避障通过率，在某些作业环境条件下，搜索覆盖率可提升50%以上，障碍通过率可提升6 0%以上。同时，创新点体现在将雁阵变换应用于多扑翼飞行机器人集群编队控制和将仿生集群行为控制应用于扑翼飞行机器人集群控制两个方面。关键词：扑翼飞行机器人；雁阵变换；仿生集群行为控制；多机器人；机器人行为；编队控制中图分类号：TP24D0I:10.19942/j.issn.2096-5915.2023.03.31Clustering Behavior Control Method of Micro Flapping-wing FlyingRobot Based on Wild Goose Array TransformationDING Wei,ZHANG Feng,SONG Min,CUI Long,WANG Hongwei,LIU Zhaoming,MIAO Lei?(1.College of Automation,Shenyang Institute of Engineering,Shenyang 110136,China;2.State Key Laboratory of Robotics,Shenyang Institute of Automation,Chinese Academy of Sciences,文献标识码：AShenyang 110169,China)文章编号：2 0 9 6-59 1 5(2 0 2 3)0 3-1 2 9-1 5Abstract:In order to solve the problems of target search and coverage efficiency and obstacle avoidanceof multi-aircraft cooperation in the cluster formation of micro flapping-wing flying robots,and realize theintelligent control of the cluster formation of flapping-wing flying robots,this paper proposes a control methodfor the cluster behavior of flapping-wing flying robots based on the wild goose array transformation.Theformation transformation and angle control of flying robot formation are realized by using the parameterizationcharacteristics of the bionic cluster behavior control function;the experimental system of multi-flapping-wingflying robot is built,and design experiments of cluster control method for multi flapping wing flying robots收稿日期：2 0 2 3-0 3-2 8；修回日期：2 0 2 3-0 4-30基金项目：国家自然科学基金合作计划资助项目（U2013208）；辽宁省自然科学基金资助项目（2 0 2 2 KF1212）130based on biomimetic behavior in multiple situations.The final experimental results verify the feasibility andeffectiveness of the method.Compared with the traditional real-time control method of multi-flying robots,thismethod greatly improves the search coverage efficiency and obstacle avoidance pass rate of the clusterformation.Under certain operating environment conditions,the search coverage rate can be increased by morethan 50%,and the obstacle pass rate can be increased by more than 60%.The innovation of this paper isreflected in the application of wild goose array transformation to the formation control of multi-flapping-wingflying robot cluster and the application of bionic cluster behavior control to the flapping-wing flying robotcluster control.Key words:Flapping-wing Flying Robot;Wild Goose Array Transformation;Bionic Cluster BehaviorControl;Multi robot;Robot Behavior;Formation Control无人系统技术第6 卷1 引 言1.1扑翼飞行机器人扑翼飞行机器人通过机器人机翼扑动拍打空气产生的反作用力提供推力和升力，并通过飞行机器人尾翼和侧翼的位置偏移来调节机身的运动方向1。扑翼飞行机器人能够完成垂直升降、悬停和滑翔等高难度运动，具有较高的运动灵活性和敏捷性。扑翼飞行机器人相较于固定翼飞行机器人和旋翼飞行机器人，具有体积小、隐蔽性高和机动性强等多方面的优势。随着仿生学、机械制造、微纳米加工、空气动力学和智能控制等技术的进一步发展，飞行机器人的研究引起越来越广泛的关注，仿生扑翼飞行机器人技术也得到了进一步的发展和提升2。微型化、智能化、集成化和集群化成为飞行机器人的发展趋势和方向，飞行机器人能够模仿鸟类和昆虫的飞行方式，灵活地完成低空侦察、监控以及搜索等任务。国内外研究团队已在仿生扑翼飞行机器人的飞行机理【3、动力学分析【4-5、扑翼机械结构设计6-1 0、飞行控制方法1-1 4和机器人视觉【1 5等方面取得了大量研究成果。其中，国外对扑翼飞行机器人开展研究较早，较多机构进行了扑翼飞行机器人系统的设计和研发工作。2005年，美国AeroVironment公司开发的仿蜂鸟扑翼飞行机器人“NanoHummingbird1 6”质量约1 9g，翼展约1 7 cm，能够持续飞行1 1 min。德国Festo公司研制的一款翼展为50 cm的仿生蝴蝶“eMotion Butterflies1 7】”。其机翼骨架采用碳纤维材料，通过两个独立的伺服电机进行机翼驱动与控制。美国麻省理工学院的“Phoenix18”。宽大的柔性翼利用碳纤维棒构成了一个三角形的结构，可提供30 0 W的强大升力。该仿生扑翼飞行机器人可实现水平稳定飞行，速度大约为4m/s，能够携带GPS等多种传感器。但其控制系统有待完善，只能以手持方式起飞，无法完成复杂飞控动作。国内关于扑翼飞行机器人的相关研究起步较晚，但自2 0 0 0 年以来也取得了一定的发展和进步 1 9-2 1 北京航空航天大学孙茂等2 2 专注于空气动力学相关原理研究，并揭示了昆虫飞行时的非定常空气动力机理。西北工业大学【2 3-2 41 研制的“信鸽”仿鸽扑翼飞行机器人采用碳纤维材料搭建骨架，利用聚酯薄膜聚合物作为翼膜，翼展50 cm，质量2 2 0 g，续航时间30 min。其在控制飞行方面，可实现自主起飞和航行，飞行机器人具有一定的抗风能力，可应用于救援和侦察等实际现场。上海交通大学【2 5研究了基于仿昆虫飞行模式的数学建模，选取光刻胶SU-8作为结构材料，采用微机电加工技术，设计了仿昆虫微型扑翼飞行机器人。北京科技大学2 6 设计了“USTB-Dove”仿鸟扑翼飞行机器人，翼展7 0 cm，质量2 2 0 g，可以通过手控或自控方式实现稳定飞行，续航时间为第3期40 min。从整体来看，国内对于仿生扑翼飞行机器人的研究成果相对集中在理论研究方面，实物实验平台的搭建相对较少，仍具有较大的进步空间。1.2飞行机器人集群编队研究现状飞行机器人集群编队是指飞行机器人集群根据不同的任务需求，构成一定的几何形态来协作执行任务，同时对环境具有感知能力，能作出适应性动态调整行为的多智能体系统。群体模型通常来自自然界和生物集群，如鸟群、蚁群、兽群、鱼群和粒子群等。集群智能系统由一群简单的个体组成，个体按照相关规则在彼此之间进行信息交互，智能体也可以与环境进行信息交互。群体智能在数量上表现为多数量，在群体层面表现为分散化、去中心化和自组织的群体特征。总体来说，飞行机器人集群编队研究内容主要包括集群构型设计与切换、控制与保持、路径跟踪、障碍规避等协作行为。飞行机器人集群编队的研究仍处于探索阶段。集群系统比人工系统具有更优越的自主性、协调性和智能性。随着飞行任务复杂度的提升，对扑翼飞行机器人在大区域中执行任务时的机动性、快速性和效率等性能提出了更高的要求，单扑翼机器人较难实现。在面对远距离、大环境信息量和高能量消耗等复杂任务时，扑翼飞行机器人集群具有感知信息量大、节省时间、作业效率高、群体能量消耗少和隐蔽性好等多方面优势，如图1 所示。仿生扑翼飞行机器人是以飞行鸟类为仿生对象，在仿生扑翼机器人集群飞行方面也需要从鸟类进化的集群机理中得到启发。通过阵型变换提升扑翼飞行机器人集群的搜索能力和环境避障能力，可以提升集群的任务执行力。所以，扑翼飞行机器人集群在远距离军事侦察、大范围环境监测、长时间灾难监测等军事或民用领域具有广泛的应用前景。综上所述，对仿生扑翼飞行机器人集群控制的研究，能够很好地解决扑翼飞行机器人集群阵丁伟等：基于雁阵变换的微型扑翼飞行机器人集群行为控制方法执行任务时扑翼飞行器单机优势可微型化、噪声低仿生程度高产生升力效率高图1 扑翼飞行机器人的技术优势Fig.1 Technical advantages of flapping-wing flying robot型选择和变换的问题。利用集群控制，实现扑翼飞行机器人集群大范围搜索、低空侦察和目标覆盖等复杂应用任务。现阶段，由于固定翼飞行机器人和旋翼飞行机器人的控制技术发展相对成熟，集群编队控制主要集中于上述两类飞行机器人。相比之下，扑翼飞行机器人具有独特的功能优势以及良好的仿生性能，其集群编队作为一门前沿发展科学，具有广阔的应用前景。2014年，匈牙利罗兰大学TamasVicsek团队2 7 借鉴生物集群行为机理，在通信延迟、GPS丢失等情况下，利用1 0 架四旋翼飞行机器人完成了障碍物躲避、阵型稳定保持和多目标跟踪等多项任务。2 0 1 5年，美国海军研究院TimothyChung团队2 8 实现了50 余架固定翼飞行机器人的集群编队飞行，利用无线自组织网络进行信息交互和共享。2 0 1 8 年，美国国防预先研究计划局设立的“小精灵”项目2 9通过集群内部的信息收集与传递，协同破坏敌方防御系统，执行情报侦察与电子干扰攻击等破坏性任务。飞行机器人编队飞行的主要目标是驱动飞行机器人形成并保持固定阵型，其控制方法主要分为长机-僚机方法、基于行为方法、虚拟结构方法和一致性方法。传统的长机-僚机方法主要由长机跟踪预设轨迹，僚机与长机保持相对位置跟随长机飞行。美国宾夕法尼亚大学Desai团队【30 提出的长机-僚机改进控制方案通过以上技术实现了无人飞行机器131执行任务时扑翼飞行器集群优势隐蔽性高、续航更远隐蔽性高信息感知量增大续航较长任务完成率提高灵活性高、整体能量消耗减少机动性强132人在非GPS定位环境中的集群编队飞行。基于行为方法是一种通过定义飞行机器人几种基本控制行为并对其进行执行和优化的编队控制方法。北京航空航天大学段海滨团队31 提出了一种基于鸽群层级群聚特性的集群控制方法，并通过多无人飞行机器人对该集群控制方法进行了仿真验证。国防科技大学王祥科团队【32 针对大规模固定翼无人机集群的编队控制问题，提出了一种分层分组控制方法，并通过1 0 0 架固定翼无人机集群的全流程数值仿真，验证了集群控制方法的有效性。西北工业大学符小卫团队33针对切换拓扑结构下的集群编队控制问题，设计了只需个别无人机获取虚拟长机信息也能保证集群连通性的编队控制算法，并进行了仿真实验，验证了算法的有效性。日本庆应大学Kuriki教授团队34结合模型预测控制和一致性控制方法，成功进行了无人飞行机器人自主防碰撞的编队飞行实验。以上几种飞行机器人集群控制方法各有其特点和适应场合，基于行为的控制方法符合人工智能的发展思路，设计合理的机器人集群行为，可有效实现集群的智能控制。根据无人机的资源利用和作战任务不同，飞行机器人集群的任务通常分为以下三类：（1）访问任务；（2）打击任务；（3）察打一体任务。其中，访问任务具体包括三种任务类型：（1）覆盖任务；（2）搜寻作业；（3）评估任务。无人机群访问任务是在满足侦测设备与能量约束的情况下，通过对机器人集群进行合理的任务分配，有效搜索、覆盖或评估访问目标，实现访问收益最大化的过程。飞行机器人集群覆盖任务是对局部目标进行连续监视和对特定区域的探测搜寻35。根据任务的执行策略不同，可以将其归类为行为式覆盖和非行为式覆盖【36。行为式覆盖策略是基于某种飞行机器人行为，优化各机器人的方向和飞行时间，以实现对任务区域最大化覆盖的目的，如图2 所示。搜索覆盖率就是飞行机器人在搜索过程中覆盖的区域面积与区域总面积的比值。搜索覆盖率可按搜索面积或搜索点来进行计算，如图2（a）所示。图中，将飞行机器人需要覆盖的面积进无人系统技术654321图2 飞行机器人覆盖任务的优化策略Fig.2Optimization strategy of flying robot covering tasks行网格化的处理，得到了6 1 0 个网格单元，飞行机器人从初始点（1，1）开始进行基于行为的巡航覆盖，直到完成覆盖任务，停止于坐标点（3，9），共对6 1 0 网格区域的42 个子区域进行了巡检覆盖。因此，基于行为的覆盖策略，其搜索覆盖率为42/6 0 1 0 0%=7 0%。而以竖“一”字形编队通过搜索覆盖区域，其覆盖率为编队覆盖区域/总搜索面积，覆盖率为6/6 0 100%=10%。避障通过率就是飞行机器人编队在面对宽或狭窄等不同飞行通道环境的情况下，其飞行编队根据自身队形实现的障碍环境通过飞机数量与总飞机数量的比值。如图3所示，飞行机器人编队以竖“二”字形编队通过最大通过宽度为一架飞行机器人的障碍环境时，其障碍通过率为1 0 0%，而当飞行机器人编队以横“二”字形编队通过最大通过宽度为一架飞行机器人的障碍环境时，其障碍通过率为1/51 0 0%=第6 卷10987：12(a)行为式覆盖策略X/cm(b)非行为式覆盖策略3X/cm456第3期20%。因此，可以看出，基于行为的覆盖搜索策略有较高的搜索效率。针对开放的非结构化的区域进行环境监测，飞行机器人集群可利用单机间的信息交互和合作，达到监测区域的动态变化，形成快速响应。对于空间搜寻、区域覆盖与监测等任务，机器人集群都是非常好的解决方法。2扑翼飞行机器人飞行机理与雁阵变换集群控制2.1扑翼飞行机器人飞行机理和雁阵变换原理雁群每年会随着季节变化而进行大规模迁徒，在迁徙过程中，雁群会以“V”字阵型或“二”字阵型进行编队排布，在保持稳定队形基础上，借助集群阵型提升群体的障碍通过性和飞行效率。单架扑翼飞行机器人在执行长距离侦察、巡逻以及多目标搜索等任务时，通常会出现续航不足的问题。利用雁阵的不同队形，可实现扑翼飞行机器人集群的大范围空间搜索、巡检和覆盖任务，“二”字阵型有利于提升集群的障碍通过率和安全性，“人”字和“V”字阵型有利于提升集群巡检的搜索覆盖率，提升巡检任务的作业效率，如图3所示。2.1.1单仿生扑翼飞行机器人模型与控制为方便仿生扑翼飞行机器人模型建模和控制形成新队形队形变换以避障无人机按一定队形探测搜索图3飞行机器人集群编队队形变换和飞行任务场景示意图Fig.3 Schematic diagram of formation transformation andflight mission scenario of flying robot cluster丁伟等：基于雁阵变换的微型扑翼飞行机器人集群行为控制方法0T=0cOSxcos sin X-sinXcos cosXJL表示一个使等式Tq,I,(Tq.）=Lj,成立的矩阵。旋转矩阵RIB=(RB）1=C B2 C 2 C 通过三个旋转矩阵得到CB2=0cos XsinXLO-sinXcOSXJcos0-sin根据任务需要，C21=Lsin0cos Jcossin07TC=-sincOS0001式中，X，表示机体坐标系下的姿态信息量。在主要考虑扑翼飞行机器人位置跟踪的情况下，通过将式（1）进行分解可得位置回路动力学模型无人机起飞并盘旋集结q.=x，y，z 表示扑翼飞行机器人在惯性坐标系下的位置向量，T，表示位置控制输人量。133器设计，在假设地面坐标系为惯性坐标系的条件下，通过拉格朗日建模方法，可以得到仿生扑翼飞行机器人的非线性动力学模型M(q)j+C(q,9)+G(q)=R(q)T式中，q:=q，q n=x y z;表示扑翼飞行机器人的位置及姿态状态向量。M,0M=表示惯性矩阵，G=L0M,00力向量，C=表示科氏力矩阵，R(q)=LOC,Rl(q.)0其中RB（q,）表示旋转矩阵，T表示0m00控制输人量。具体地，M,=0m0 其中mLO0表示扑翼飞行机器人的质量，M,=I,T，G,=0，0，m g I 表示重力向量，其中g为重力加速度，C,=I,T+L，其中I,表示转动惯量矩阵，T表示坐标转换矩阵11010M,i+G,=RT,(1)G.表示重-sin(2)00(3)(4)(5)(6)1342.1.2仿生扑翼飞行机器人编队阵型排布与集群模型阵型切换思想主要源于大雁长途迁徙现象：雁群在整个迁徙过程中，会以“V”字阵型飞行实现整体能量优化，同时也会根据环境变化随时改变群体阵型，可将雁阵变换思想应用于扑翼飞行机器人集群，以提升飞行机器人集群的巡检能力和效率。无人系统技术“僚机”第6 卷“长机”b元b/4O“僚机”按照“V”字阵型排布，第三排的扑翼飞行机器人与第一排的扑翼飞行机器人之间的横向距离为b/2，纵向距离为4b，垂直距离不变，对应的最大升力和阻力变化量分别为L=0.0113N和D =0.0 0 1 8 N。由于LAL以及ADD，在阵型分析过程中只考虑前排扑翼飞行机器人对其最近后排扑翼飞行机器人的影响。前排飞行的扑翼飞行机器人产生的翼尖涡流方向主要为机翼的正后方，同排飞行的扑翼飞行机器人之间的横向距离为b/2，其对应的升阻力变化值同样远小于L和D，如图4所示。在稳定飞行情况下，通过拉格朗日建模方法，可以得到仿生扑翼飞行机器人集群位置回路的非线性动力学模型Maja+Ga=R.Ta+Uu+Fu式中，q=q，q=x;z;表示第i个扑翼飞行机器人的位置向量，M.表示惯性矩阵，G,=0，0，-m g 表示第i个扑翼飞行机器人的重力向量，T=t i，T i，T i 表示第i个扑翼飞行机器人的控制输人量，u.表示第i个扑翼飞行机器人在翼尖涡流影响下受到的额外升阻力向量，当i为“长机”时ui=0，Ft=-Fx i，Fy，F,表示第i个扑翼飞行机器人在三轴方向所受到的阻力、侧向力与升力。第i个扑翼飞行机器人的旋转矩阵R,B,通过式（3）（5）所示的三个旋转矩阵得到。在此仅考虑偏航角为统一变化值，横滚角X和俯仰角为固定值的情况。2.2基于仿生集群行为的集群控制方法2.2.1仿生运动行为综述仿生学诞生于上个世纪6 0 年代，仿生技术是在研究生物体、生命系统等结构与功能原理的基元b/4X4图4扑翼飞行机器人集群编队阵型Fig.4Flapping wing flying robot cluster formation(7)础上，根据这些生命特征原理形成的先进技术和应用。生物行为就是具有某些特征的生物动作序列和集合。而机器人行为与生物行为类似，通过仿生运动行为控制将机器人的特征行为进行精确的建模和应用。在2 0 多年的发展过程中，多机器人编队控制形成了多种具有代表性的研究方法【37-41，包括领航-跟随法、基于行为的方法、人工势场法和虚拟结构法等。基于行为的方法较为形象并易于理解，在机器人导航、编队与协作、机器人足球和人机交互等方面获得了广泛的应用。上世纪8 0 年代，美国麻省理工学院的RodneyBrooks42提出了机器人行为控制方法和包容式的体系结构，将行为引人到机器人研究中。2 0 0 4年，Naffin等在协作、通信、运动、编队保持和传感等(a）集群编队位置关系图2(b）集群编队“人”字形编队5第3期方面为多机器人编队设计了1 6 种行为，以执行和完成编队任务43。2 0 0 9年，Ray等为多机器人编队设计的分布式行为选择机制，取决于编队开始时处于领航者地位的机器人的初始状态44。在国内，经过多年的积累，也形成了一系列的多扑翼飞行机器人集群编队控制算法的研究成果【45-51。2 0 2 1 年，北京航空航天大学段海滨等研究了鸽群导航行为模型，探索了信鸽归巢多种复杂行为学的内在机理。信鸽归巢导航过程呈现出了三个阶段：（1）Map-and-Compass阶段，信鸽处于高熵状态，对应依靠地图罗盘的导航行为；（2）Le g Le n g t h 阶段，信鸽处于中熵状态，对应飞行中重定向期间的导航行为；（3）ImmediateHome阶段，信鸽处于低熵状态，对应鸽子在鸽房附近快速归巢的行为。2.2.2仿生运动行为控制核心思想和理论模型仿生行为控制的核心思想就是把底层的具体运动细节交给执行机构，控制系统高层只负责整体运动规划。在传统的遥操作机器人控制系统中，期望轨迹在机器人核心控制器中生成，并对期望轨迹采样，以对机器人进行实时的运动控制，对于操作者来说工作量较大。基于仿生运动行为的控制系统架构不再传输离散的轨迹采样点和基础数据，而是直接传输参数化的轨迹函数。参数化的轨迹函数，是指利用变换函数，把轨迹映射到一些定义的运动行为函数上，通过对行为函数的线性组合就可以还原参考轨迹。通信系统只需要传输几个运动行为函数参数，即可实现轨迹控制。在这种架构下，通信传输量将大幅下降而控制精度却能够得到保证。仿生运动行为控制框架的系统结构如图5所示。仿生行为控制字母表中的行为函数为二元组=（，）的形式，允许每个行为函数在一个任意长的时间段内执行。在仿生行为控制系统结构中，机器人控制器可进行路径规划和机器人的轨迹生成，并通过仿生行为生成器生成仿生行为序列。随后，将运动行为序列发送给运动行为解析器，以控制机器人执行机构，来完成机器人的路径规划和作业任务。在仿生运动行为控制框架下，用运动机对机丁伟等：基于雁阵变换的微型扑翼飞行机器人集群行为控制方法路径规划金轨迹生成仿生行为生成器仿生行为字符串仿生行为解释器金终端运动控制运动控制器图5优仿生运动行为控制理论框架的控制系统结构Fig.5Control system configuration of BCBC framework器人系统进行建模，用以描述机器人在离散时间接收仿生运动行为命令并产生连续运动的特征。仿生运动行为控制的模型称为运动状态机模型，就是生成从状态空间到输出空间的映射关系模型，其状态方程为=G(x)(u+hk(y)y=h(x)式中，x，y 和u为时间变量的矢量函数，G为矩阵，h和k是矢量空间之间的映射。二元组（f.）称为“行为函数”，由这些二元组构成的集合称为“字母表”。机器人控制程序表示为由字母表中的行为函数构成的符号串的形式。如果运动机的初始状态为x。=（t。），在接收到符号串（f，i，T）（f a，2，T,）（f，T,）后,其运动规律可以描述为i=G(x)(ur+ki(y);i=(x)(uz+k2(y);i=G(x)(u,+k.(y);to+i=式中，u、y均是时间t的函数。u是连续输人控制函数。x是n维系统状态函数。是一个系统输出函数。k是状态反馈。135机器人控制器(8)totto+Tto+T,tto+T,+T2：+T.IZ，用于确定下一采样周期内将要执行的行为函数相对于当前行为函数的位置。0，如果/x+y2R1，如果/x2+y?Rx-y2，如果/tan+1（f z，z）和（f，）的符号定义和函数说明参考（fi，）。根据以上行为函数的定义，可以得到实现飞行机器人位姿镇定的运动字母表Z=(fi,),(fz,小2),(fs,4s)将一个连续系统分段表示，然后将每一段用参数化的运动行为函数（f，山）表达，就可以用一串离散的符号序列来驱动一个连续系统。在仿生行为控制框架下，从初始时刻开始，仿生运动行为编译器接收到一个运动行为函数的序列，随后编译器将这个序列翻译成分段映射。仿生行为过程用运动行为函数表达，将行为构成的符号串用于运动规划。3多微型扑翼飞行机器人集群编队控制实验研究及分析3.1多微型扑翼飞行机器人集群控制实验平台及实验过程微型扑翼飞行机器人实验系统由飞行机器人本体和地面控制单元两大部分组成。扑翼飞行机器人机身本体系统由高强度碳纤维机身、X型翼、机载微型电路板、微型电机和传动机构等组部件构成。扑翼飞行机器人集成了MEMS工艺的仿生弹无人系统技术飞行机器人方位角将趋向于期望直线的角度，行为函数（fi，）中相应的符号定义为sin(0-)(n(-)+h,u.i0-性翼，X型翼在工程上较易实现，可实现翅翼单自由度上、下扑动。扑翼飞行机器人翼展1 4cm，可连续稳定飞行1 3min以上，质量仅有6 g，如图6（a）所示。飞行机器人机身可安装陀螺仪等传感器，可实现扑翼飞行机器人的自平稳飞行、转弯和避障等飞行功能。地面控制单元装置包括接收天线、线路放大器、计算机等结构组部件。扑翼飞行机器人地面(11)控制单元如图6（b）所示，其控制手柄包括四个=0并且0=方向按键和加减速按键，通过天线将控制单元的数据级和行为级指令发送给扑翼机器人，同时可将扑翼机器人状态信息和机器人视觉信息回传给地面控制单元。地面控制和接收单元主要用来接收机器人机载信息和视觉传感器实时回传的信息，(12)并将数据和信息进行记录和存储。扑翼飞行机器人单机可利用机载视觉进行导航，扑翼飞行机器人的载荷可达5g。图传模块利用模拟图传，频率为5.8 GHz，质量仅为2 g，可实现图片与视频的高速、高带宽传输。扑翼飞行机器人的载荷能力完全能够承载图传单元等载荷。导航实验方面，在室内进行扑翼飞行机器人三机的初步编队飞行实验，三机编队飞行利用地面控制器来对三扑翼飞行机器人进行飞行机器人本体验证和编队初步验证。3.2基于仿生行为的多扑翼飞行机器人集群控制方法实验及分析扑翼飞行机器人实验环境如图7 所示，利用两根竖杆和杆连接线缆来模拟线缆巡检任务和作业环境。通过设计实验，以七架扑翼飞行机器人编队为实验研究对象，在集群编队“人”字形到“”字形的转换、“人”字形到“”字形的转换、编队避障与掉头控制和编队手动控制与仿生行为控制等多种情况下进行实验研究，以验证仿生集群行为控制方法的有效性。第6 卷(10)(y cos-x sin)第3期丁伟等：基于雁阵变换的微型扑翼飞行机器人集群行为控制方法飞行机器人微型飞行机器人电机及传动机构X型翼飞行机器人机载电池飞行机器人控制单元137编队头机处于飞行方向的中间最后列，其他飞行机器人在头机的侧前方向依次排列，为“人”字形排列的反方向阵型。横“二”字形为多飞行机器人沿着飞行方向并行飞行。竖“二”字形为多飞行机器人沿着飞行方向前后跟随飞行，形成竖向排列的阵型飞行机器人尾翼及控制机构明德到(a)扑翼机器人结构飞行机器人图像传输单元地面控制站视频显示地面控制站机器人状态显示地面控制站状态显示地面控制站键盘地面控制站地面控制站方向手柄通信天线(b)地面控制站及图传单元(c)扑翼飞行机器人编队实物图图6 扑翼飞行机器人结构及地面控制站和图传单元Fig.6 Flapping-wing flying robot structure,ground control sta-tion and image transmission unit飞行机器人编队的“人”字形定义为飞行机器人头机处于飞行方向的中间最前列，其他飞行机器人在头机的侧后方依次后向排列，如图4所示为人字形排列。而“V”字形排列为飞行机器人图7 微型扑翼飞行机器人集群飞行实验Fig.7 Cluster flight experiment of micro flapping-wing flyingrobot飞行机器人飞行机器人在X、Y和Z三维空间进行轨迹运微型摄像机动。飞行机器人的控制方式是给定了机器人的初始位置、机器人的运动速度和空间控制角度，飞行机器人即可进行飞行轨迹运动。飞行过程中，可根据飞行机器人的位置、姿态和算法进行编队调整，以完成飞行机器人的作业任务。微型扑翼飞行机器人飞行实验如图7 所示，外圈蓝色虚线为飞行机器人编队的飞行轨迹方向曲线，实验以三个扑翼飞行机器人为三角形编队，形成了三角形飞行机器人编队的阵型，如图7 中蓝色三角形队形所示。扑翼飞行机器人的行为就是具有相似特征的机器人动作集合，如平面圆形飞行等，并且机器人行为与运动行为函数符号相对应。通过对多扑翼飞行机器人集群编队特点进行分析，结合鸽群三阶段归巢行为模型，将扑翼飞行机器人导航过程分为：（1）第一阶段一一高自然罗盘导航阶段；（2）第二阶段一一中熵重定向导航行为阶段；（3）第三阶段一一低熵状态快速归巢行为阶段。设计十一个行为函数和字母表对飞行机器人编队进行控制，其仿生集群行为138函数如表1 所示。表1 飞行机器人空间运动的仿生集群行为函数表Table 1Function table of BCBC for flying robot space motion仿生行为控制信鸽导航序号行为分类1编队直线运动2编队平面左半圆盘旋运动3编队平面右半圆盘旋运动4编队三维圆柱曲线前进运动5编队“V字形变换6“V队形变换结束-保持队形7队形转弯8转弯结束-保持队形9队形避障10队形掉头11队形避障结束-保持队形实验地面平台的控制方式采用基础行为集合：上、下、左、右，基于作业任务分析的机器人集群特征行为集合：编队“V”字形变换f、编队避障f、编队掉头运动fio、编队队形保持fi。（f,）、（f，z）、（f，）、（f，）.中，为机器人运动状态控制函数，出为机器人运动切换函数。通过以上扑翼飞行机器人的行为规划，可实现扑翼机器人的智能行为控制，无需根据扑翼机器人的飞行状态和飞行环境实时发送控制命令，通过基于仿生运动行为控制的智能控制策略可大量节省控制器实时控制的负荷，大量减少底层位置控制的压力，基于集群行为的智能控制方法为人处于控制闭环的机器人遥操作提供了有力的控制解决方案。扑翼飞行机器人机身上装有微型陀螺仪用来记录扑翼飞行机器人的姿态数据。飞行机器人陀螺仪的数据采用了四元数法，记录数据如表2 所示。根据扑翼飞行机器人陀螺仪的姿态数据，可以更多了解飞行机器人集群的姿态信息和数据信息，为扑翼飞行机器人集群控制提供了更多的硬件保证和数据支持。利用竖杆和横杆作为实验场地的飞行标记点位，实验的目的是利用三扑翼飞行机器人的三角无人系统技术Table 2FFlapping-wing flying robot gyro data sheet时间/ms9621-0.7094623-0.7106行为函数三阶段(f山)一(f小2)一(f)一(f4.)一(f,s)(fo小。)(f小)(f小s)(fio410)(fid)第6 卷表2 扑翼飞行机器人陀螺仪数据表q-0.1968-0.1952632-0.7096663-0.7120673-0.7126681-0.7126形编队变换来验证扑翼机编队变换，以形成初步编队变换验证数据并进行数据分析。以地面杆作三二三二二三q0.21200.64271100.21360.6413420-0.19610.2128-0.19470.2138-0.19480.2135-0.1950.2064为标记点，利用地面控制台对飞行编队进行加速和行为控制，实现正三角扑翼机器人编队向倒三角飞行机器人编队的阵型转换。根据以上仿生行为函数的定义和规划，设计以下一些仿真实验来验证基于雁阵变换的扑翼飞行机器人集群行为控制的有效性。飞行机器人编队轨迹生成实验是仿真软件实验，本实验考虑将扑翼飞行机器人简化为三维智能体点，重点研究编队的轨迹规划、编队轨迹和编队通过率及避障等后续问题。（1）“人”字形一V字形转换七个扑翼飞行机器人分别从各自的初始位置七个坐标点：（4，4)；（4，0)；（0，4)；（4，2);(2，4)；（4，-2)；（-2，4)出发，机器人的运动方向为与XOY平面呈45的直线方向。然后，给七个扑翼飞行机器人发送队形转换行为函数指令，七个扑翼机器人经过队形转换后，变成倒三角队形，由原来的“人”字形编队变为“V”字形编队队形。随后发送队形转换行为函数结束命令，七个扑翼机器人继续以“V”字形进行匀速直线运动，如图8 所示。（2）“人”字形-横“二”字形转换七个扑翼机器人分别从各自的初始位置出发，机器人的运动方向为与XOY平面呈45的直线方向。随后，给扑翼飞行机器人编队发送仿生运动行为控制指令，扑翼机器人编队进行队形变换，变为横“二”字形队形。随后，扑翼机编队继续进行匀速直线运动，如图9所示。由七个扑翼飞行机器人组成的集群编队分别0.64243980.63987300.63927460.6415413第3期丁伟等：基于雁阵变换的微型扑翼飞行机器人集群行为控制方法139302520151050-5-10-10-5051015202530-10X/cm(a)基于雁阵变换的编队控制30201030020100302010-100-10-5051015 202530X/cm(a)基于雁阵变换的编队控制-10302520151050-5-10-10-5051015202530-10X/cm(b)基于雁阵变换的编队控制图8 基于仿生集群行为控制的“人 字形转换“V字形运动行为空间轨迹图Fig.8Space trajectory of“v type movement behavior of“herringbone”type transformation based