【四旋翼无人机运动控模型研究9100字】

四旋翼无人机运动控模型研究目录TOC\o"1-3"\h\u11788四旋翼无人机运动控模型研究 1289131.1四旋翼无人机控制原理 255871.2四旋翼无人机姿态表示 5238521.3控制方案分析 6105141.4控制器设计 8214411.5控制器切换策略 1030711.6无人机目标定位与自动导航控制算法 13本课题所涉及的四旋翼无人机属于小型“＋”字型无人无人机，自带GPS定位模块、电子罗盘，遥控协议开放。自动起降控制模块的主要任务通过实现姿态、具体位置操作控制完成四旋翼无人机的自动智能起飞和降落操作控制。本章的核心内容是做出四旋翼无人机数学实验模型，并且针对四旋翼无人机展开研究分析，在这其中，通常包含：实验模型的耦合作用性及稳定安全性研究分析。因为此小微型四旋翼无人机飞行速率低，属于近悬停点飞行，特征改变较低，因此把实验模型在悬停点展开数学线性化。经过将会对象特征以及所要完成的工作任务需要展开全面分析可知，提出了操控系统总体设计规划方案[27]。四旋翼的主要由机架、旋翼、电机、负载设备、控制器及电池等组成如图1.1所示。图1.1四旋翼无人机的各组成架构示意图在这其中，每一个机架设施顶端都装配置了联动电机设备以及正反桨翼，底端都承载有电子变速控制器设备。机架设施中部的固定应用平台用于装备设施飞行操作控制的工作电路控制板与供应电源工作电源等，与此同时，也能够承载多种负荷例如摄像头、无线通讯设备。四旋翼飞机具备数个自变量、呈非线性关联、强耦合作用以及对外部影响干扰比较敏锐的特征。飞控体系的作用功能通常是由实验模型建设的确定性与感应设备的准确度判断。四旋翼机架设施应用互相对称的刚性垂直交叉组成结构，使各旋翼相互之间形成的旋转力矩彼此去除，所以不需要使用庞杂的反弯曲扭矩旋翼。经过调节控制4个原始推动力电机设备的速率来操作控制四旋翼机空间运动，与其它直升机、固定翼飞机的飞行操作控制模式存在核心本质的不相同，旋翼充分加强了自身的升力，可以承担更大载荷。具体是使用电机设备操作控制4个旋翼的实际转速使单个或者两两相互之间产生速率差，使每一个旋翼相互之间形成旋翼转轴分布方向以及垂直作用于旋翼转轴分布方向的原始推动力，进而转变设备机身位姿的偏向角，进而操作控制飞行控制器设备具体位置与速率。1.1四旋翼无人机控制原理四旋翼无人机通过改变自身4个旋翼的转速，可以比较灵活地进行各种飞行动作。其主要依据的运动原理是力的合成与分解，以及空气转动扭矩的反向性。四旋翼无人机通常有两种模式，即“＋”字形模式与“×”形模式[26]。四个旋翼的实际转速基本规律是相邻的2个旋翼的机械转动分布方向完全相反，但是在对角线上的2个电机设备的机械转动分布方向相同。例如，图1.2中的“＋”形模式，1、4电机是顺时针方向转动，而2、3电机是逆时针方向转动。这样为了保障它们形成的升力都是向上的，1、4电机设备要求运用的螺旋桨是正转，即为顺时针方向转动能产生向上升力；而2、3电机使用的螺旋桨是反转，即逆时针方向旋转产生向上升力。在装配电机轴时，应注意4个旋翼都是向下吹风的，以确保四个旋翼都能提供向上升力[28]。图1.2X形模式与“十”字形模式这样做的原因是基于无人机旋翼在旋转时会产生反扭矩。假如，所有旋翼都顺时针方向转动，空气会产生使得四轴逆时针方向转动的反向扭矩，使得四轴在偏航方向不能保持平衡，会出现自旋转现象。四旋翼无人机可以分别沿着机体的X、Y、Z三个轴进行旋转或者平移运动，因此在每个轴向上有两个自由度。四旋翼无人机有4种基本飞行动作。(1)升降运动升降运动（如图1.3所示）实际上就是无人机在Z轴方向的上下运动。假设四旋翼无人机位于平稳分布状态，四个旋翼实际转速完全相同。这个时候实时同步增长使四个旋翼实际转速，能够让升力提高从而有效克服机体实际有效重量，使机体垂直向上空间运动；相反，实时同步降低四个旋翼的实际转速，可以促使机体垂直朝下空间运动。当四个旋翼位于某一实际转速的时候，升力与机体重力实现平衡，此时无人机可处于静止运动（悬停）状态。图1.3升降运动(2)俯仰运动设定X轴正方向为无人机前进方向即电机4为前方，俯仰运动是无人机以坐标y轴为中心轴的一个转动。如图1.4所示，以仰动作为例，保持电机1、3转速不变，同时增加电机4的转速使升力加大，降低电机设备2实际转速使升力减少。无人机遇以机体Y纵坐标轴为转轴形成一个机械转动，这就是无人操控机的仰动作；相反，维持电机设备1、电机设备3的实际转速恒定，让电机设备2实际转速增长，电机设备4实际转速降低，把完成无人操控机俯的动作。俯仰动作要求经过操作控制无人操控机前后分布方向上的2个电机设备的速度来完成。俯仰动作事实上会直接影响无人机的前进和后退动作。图1.4俯仰运动(3)横滚运动横滚空间运动和俯仰动作理论相同，如下示意图1.5所示，维持电机设备4与电机设备2的实际转速恒定，依次操作控制电机设备1、3的实际转速，可以促使设备机身以机体分布坐标的X横坐标轴为旋转中心轴展开旋转。横滚动作事实上可实现无人机的左移和右移动作。图1.5横滚运动(4)偏航运动（自旋）偏航运动实际上是机体绕自身坐标Z轴的一个自旋转的过程。以单个旋翼来看，每个旋转中的旋翼都会对机体产生一个反扭矩。如果无人机为单旋翼，在旋翼转动时，机身会朝反方向旋转。因此，多轴无人机的旋翼均为偶数个，而且正反转各一半。这样在飞行中，正反转旋翼的反扭矩会相互抵消。四旋翼无人机的偏航运动实质上是通过4个旋翼转速不同而使得扭矩不平衡的结果，就是使得机身绕机体坐标Z坐标轴旋转。如下示意图1.6所示，当增长电机设备4与电机设备2实际转速，与此同时，降低电机设备1与电机设备3实际转速，电机设备4、2的反弯曲扭矩高于电机设备1、3的反弯曲扭矩，设备机身会以机体Z坐标轴为转轴以电机设备4、2旋转分布方向的反分布方向旋转；相反，当电机设备1、3的实际转速增长，电机设备4、2的实际转速减小时之后，设备机身会朝和电机设备1、3机械转动完全相反的分布方向旋转[29]。图1.6偏航运动1.2四旋翼无人机姿态表示在构建四旋翼无人机控制系统的数学模型时，首先建立惯性坐标系n(OXYZ)和飞行器坐标系b(OXYZ)这两个基本坐标系，如图自动导航分布坐标系可定义在地球表层的正交分布坐标系，如下标n标记，原点为无人操控机起飞点，也就是摄像机的图像感应设备初始处理化具体位置点，记录为On，各分布坐标轴定义具体如下所示：1）X横坐标轴指向北极点，记为xn；2）Y纵坐标轴和赤道平行指向东方，记录为yn；3）Z坐标轴垂直作用于xn-o-yn平针对上，记录为zn。机体分布坐标系固连于无人操控机，俗称中间载体分布坐标系，如下标b标记。各分布坐标轴定义具体如下所示：1）原点具体位置与无人操控机核心具体位置重合，记录为Ob；2）X横坐标轴指向电机设备4（机头具体位置），记录为xb；3）Y纵坐标轴指向电机设备1（设备机身右端），记录为yb；4）Z坐标轴指向机底端，垂直作用于xb-o-yb分布平面，记录为zb。具体如下示意图所示：图1.7导航坐标系与机体坐标系无人机坐标系到惯性坐标系的转换矩阵如下。R=RxR在建设以上分布坐标系的基础之上，假定无风低速飞行的时候，逐渐忽视摩擦阻力参数，能够获取如下数学实验模型，即xyzϕθψ其中，各字符含义如表1.1所示。表1.1字母定义变量含义l旋翼中心到坐标原点的距离m飞行器质量U垂直速度控制量U翻滚输入控制量U俯仰控制量U偏航控制量四旋翼无人机具有六个自由度，通过惯性测量单元实时测量无人机三个轴向的旋转角速度和加速度，进行姿态解算，即对数据进行处理融合后得到当前飞机的姿态信息，控制飞行器的四个输入控制量，无人机即可达到平衡飞行的目的[30]。1.3控制方案分析参考依据以上对实验模型的研究分析可以得知，欧拉角Ø、θ、ψ，角速度p、q、r都为内层角空间运动实时动态特征，在同一时间尺度内；具体位置量x、y、z和速率量u、v、w都为外层线空间运动实时动态特征，属于同一时间尺度。根据四旋翼无人机各分布状态变化量的有效时间尺度不相同，针对在本文中，笔者的无人操控机，综合系统设计一个分层操作控制组成结构的自动智能飞行操控管理体系，详细内外环组成结构，具体见下图所示3.4所示，在这其中，内环应用在稳定欧拉角Ø、θ、ψ，角速度p、q、r的实时动态特征；外环操作控制无人操控机的具体位置x、y、z。整体上，和外环有关的实时动态特征要比内环慢很多。经过上一节研究分析可以得知，因为建立模型时未深入思考阻尼作用以及建立模型过程里获得的系数会有确定的有效误差，所建实验模型不是非常地准确，所以要求综合系统设计一类控制操作设备能削弱建立模型有效误差创造的主要问题和矛盾，在这里在本文中，笔者里引进了内环操作控制应用自抗扰操作控制模式综合系统设计，应用在保障无人操控机空间运动的稳定，与此同时，遏制扰动。自抗扰操作控制模式通常都是针对抗不明确体系的操作控制矛盾问题而指出的，其中心综合系统设计理论思想是经过应用对外扩张分布状态观察测量控制器设备对被控目标对象里的不明确实时动态以及接受的外界不明确扰动展开实时在线估测补偿，所以能够不完全依靠于目标对象及外界实时动态准确实验模型的模式展开非线性关联实时动态补偿，进而能够完成对富含比较多作用范围不明确性体系的操作控制。通常具体位置操作控制相比较于姿态操作控制较简易，因此外环应用典型PID操作控制模式综合系统设计[29]，为内环操作控制自动生成并且自动输出飞控指示，在这其中，外环控制操作设备的无人操控机具体位置数据信息正常飞行实际状况下由北斗/GPS供应。根据本次研究课题对四旋翼无人机所需完成的工作任务需要和机载设施机器设备的特征展开综合考核，在本文中，笔者应用分工作任务操作控制理论思想对四旋翼无人机展开操作控制律综合系统设计，操作控制组成结构如下示意图所示，也就是无人操控机全面进入视觉图像处理登陆工作任务之后，这个时候无人操控机具体位置数据信息是通过视觉图像处理体系供应的，以前根据北斗/GPS自动导航的外环控制操作设备早已不适合应用在此实际状况了，所以需专门特意综合系统设计应用在视觉图像处理登陆工作任务的外环控制操作设备，方便控制操作设备能适用根据视觉图像处理自动导航的特征。经过对四旋翼实验模型的原理研究分析可得出，四旋翼无人机是个欠联动、非线性关联的庞杂体系。因为直升机各分布状态变化量的有效时间尺度不相同，我们应用内外环组成结构的自动智能飞行操控管理体系，具体如下所示文图1.7所示。在这其中，内环应用在稳定姿态角Ø、θ、𝜑，角速度p、q、r；外环应用在操作控制当地NED分布坐标系具体位置xn、yn、zn，与机体分布坐标系线速率u、v、w。整体分析和外环有关的实时动态特征要比内环慢很多。由于本次研究课题组所应用的是微小微型四旋翼无人机应用平台，这个无人操控机质量轻、有效容积小，有进一步灵活多样性与机动性，但是更容易受到外部作业环境的影响干扰，例如阵风。不单单如此，因为建立模型的不准确性，促使对控制操作设备的综合深化设计运行工作创造了很大困难。所以，要完成姿态稳定与抗内部扰动、抗外界扰动，内环操作控制能够选用自抗扰操作控制模式。经过内环姿态操作控制完成了无人操控机的姿态稳定和抗外界干扰性，又由于在本文中，笔者里的四旋翼无人机飞行操控管理体系主要针对小速率控制范围里飞行而综合系统设计的，并没有需求展开庞杂的机动飞行，因此外环具体位置操作控制能够应用相对简易的控制操作设备操作控制。1.4控制器设计在本文中，笔者自动智能飞行操控管理体系的外环是需要操作控制无人操控机在当地NED分布坐标系内部的具体位置[30]，实现期望的轨迹飞行，综合考虑以下几点因素：1）环境自然风干扰一般影响无人机飞行姿态，主要是影响角运动；2）本课题的任务并不需要控制无人机进行复杂的精准机动飞行；3）无人操控机自抗扰操作控制数据信息计算量大，假如外环也应用自抗扰操作控制把会直接影响整个操控管理体系的工作效率。因除此之外环能够应用典型PID操作控制模式展开综合系统设计。在完成内环姿态操作控制的基础之上（可采用无人机自带具有自抗扰功能的飞控器），综合系统设计四旋翼无人直升机的外环具体位置操作控制。其组成结构如下示意图1.8所示。位置控制器位置控制器速度控制器内环运动控制器四旋翼飞行器模型𝜙，𝜃，𝜑u，v，wRb/nVn,rVb,rPn,rab,r图1.8外环控制结构框图这个操作控制组成结构能够在希望具体位置有效误差需求较低时充分保障无人操控机可以以中等速率飞行，本期望具体位置有效误差需求小时充分保障无人操控机能够低速率飞行。外环控制操作设备的综合深化设计过程具体如下所示：根据以上示意图能够得知外环操作控制律主要包括：线速率操作控制与具体位置操作控制两大组成部分。惯性分布坐标系内三分布方向具体位置操作控制具体如下所示：（1.2）在这其中，为惯性系下的三分布方向希望线加速率操作控制量。希望的机系统最大下线速率：（1.3）在这其中，为机系统下的希望线速率；Rb/n为惯性系到机系统的交换分布矩阵。三分布方向线速率操作控制律具体如下所示：（1.4）在这其中，为机系统下三分布方向希望线加速率操作控制量。因为在本文中，笔者里应用的四旋翼无人机空间运动姿态改变不大，因此经过所得的机系统下三分布方向希望线加速率操作控制量能够相似推导出希望的滚转角操作控制量、希望的俯仰角操作控制量与垂向操作控制量总距。如下式：（1.5）整理后可得控制量：（1.6）在这其中，四旋翼无人机在悬停点周围小角度飞行项能够补偿机体在俯仰与滚转空间运动时候的升力经济损失，加强实际高度信号通道的稳定安全性。1.5控制器切换策略视觉图像处理自动导航主要应用机器设备视觉图像处理专业技术来模拟仿真人的眼睛观测水平，从摄像机获得的实际环境的图像里应用计算机专业技术选取有价值的数据信息，进而获取无人操控机飞行要求的自动导航数据信息。视觉图像处理自动导航体系通常是由摄像机视觉图像处理图像收集、主要控制电脑计算机图像全面处理以及无线通讯三组成部分构成。在这其中，视觉图像处理数据信息收集组成部分是通过摄像机实现了对飞行发展路线规划图像的快速收集运行工作；之后对收集的图像展开加强、边缘选取与辨别估测等的视觉图像处理图像全面处理运行工作；最终使用目标计划定位运算方法，实现对无人机中心位置空间坐标计算，为控制无人机自动着陆提供控制数据信息。经过应用机器设备视觉图像处理全面处理专业技术能够从客观实际图像里获得有关的自动导航数据信息，完成对图像里的发现目标物的辨别估测，因此视觉图像处理自动导航要求选用恰当的参考物作为参照目标对象，并且只可以获取两物品的相对空间运动分布状态的数据信息。因为电脑计算机视觉图像处理体系的应用能够获取非常丰富的环境数据信息，而且具备环境适应性能强、有效容积小、质量轻、抗外界干扰性好、作用功能完善、数据信息完整以及使无人操控机具备更加强大主动性等应用优势。因为不相同的自动导航专业技术有其独有的作用控制范围与运用基本条件，从而应该参考依据现行基本条件全方位思考视觉图像处理自动导航专业技术的特征与四旋翼无人机要求承担的差异工作任务选用恰当的自动导航战略和制导运算方法。根据上述研究分析能够得知视觉图像处理自动导航获取的飞行系数是相比较于发现目标物的具体位置。参考依据现行专业技术研究分析可以得知，因为电脑计算机在全面处理图像时要求耗费的有效时间非常多，当这段全面处理时间过去之后，四旋翼无人机的分布状态早已产生了比较多的转变，如果这个时候还不断根据早已之前的分布状态进一步全面处理，无人操控机的分布状态就会永远掉在时间的后面，这就引发操作控制量的相对落后，造成自动导航准确度降低。为了获取高功能的操作控制，要求思考视觉图像处理体系的大延的时候，要对视觉图像处理数据信息展开预计与插补，也就是成立相对具体位置的数学实验模型，至此预计下一采样收集时间点的相对具体位置。经过以上对自动导航模式的研究分析可以得知，上一章节所描述的操作控制组成结构（如下示意图3.4）不合适应用在根据视觉图像处理信息反馈数据信息的操作控制，所以，要求专门特意综合系统设计除此之外的操作控制设计方案应用在视觉图像处理登陆的操作控制[31]。研究分析在本文中，笔者所做运行工作，四旋翼无人机在巡航、点对点飞行等飞行分布状态下还是应用北斗/GPS自动导航模式展开运行工作，只有在自主独立登陆分布状态下应用视觉图像处理体系展开登陆自动导航。所以，在本文中，笔者应用双操作控制组成结构展开综合系统设计四旋翼飞行控制操作设备，操作控制组成结构具体如下图1.9所示。速度控制速度控制器内环自抗扰控制器四旋翼飞行器模型视频信号··12开关监控位置控制器视觉图像处理控制器图1.9根据视觉图像处理自动导航的自主独立登陆转换操控管理体系组成结构因为视觉图像处理体系仅仅只是和四旋翼无人机外环具体位置操作控制相关，但是所获具体位置数据信息又和GPS感应设备所获数据信息不相同，所以内环控制操作设备应用无人机内部自抗扰控制操作设备展开操作控制，外环控制操作设备要求重新再次综合系统设计用来满足视觉图像处理体系。图1.9里有两大类操作控制信号通道，完成不相同工作任务的转换，第1类是应用在自动导航模式的操作控制循环回路，主要完成自动智能巡航；第2类是专门特意应用在根据视觉图像处理自动导航的自制登陆操作控制循环回路，具体实现根据图像全面处理的自主独立登陆工作任务。以上两大类操作控制循环回路里内环姿态操作控制运算方法是相同的，都是应用无人操控机内部自抗扰控制操作设备完成姿态的稳定。当四旋翼无人机要从普通飞行工作任务全面进入根据视觉图像处理自动导航的自主独立登陆工作任务的时候，要求迅速平稳的转换控制操作设备，则图里的控制开关监督控制功能模块是两大类操作控制循环回路展开转换的转换功能模块，下面研究分析根据视觉图像处理自动导航的操作控制模式以及两大类循环回路的转换战略。假定四旋翼无人机才开始应用第1类操作控制循环回路展开飞行，系统发出无人机着陆命令，控制无人机向车载自动起降控制平台靠近，同时开启视觉系统，对无人机进行实时搜索、检测，当检测无人机进入到视频导航控制范围后，体系紧接下来全面进入使用视觉图像处理数据信息导引实现了无人操控机自主独立登陆的方式，工作流程如下示意图1.10所示。因为这两大类模式里所应用的外环运动轨迹追踪操作控制律是不相同的，因此要求展开操作控制组成结构的转换，也就是从第1类操作控制组成结构转换到第2类操作控制组成结构。如果根据视觉图像处理自主独立登陆控制操作设备的参照输出数值和旧有传统类型的操作控制组成结构的参照输出数值相差比较多的时候，容易导致操作控制量形成突变，非常容易造成无人操控机形成意外突发事故，所以要求尽可能规避此类实际状况的产生。为了处理解决这个矛盾问题，在本文中，笔者引进了控制开关监督控制功能模块，此功能模块一直监督控制操作设备转换的契机，当转换基本条件成熟稳定时控制操作设备才可以转换全面进入视觉图像处理自主独立登陆方式。着陆着陆视频分析、检测视觉自动着陆控制启动视觉系统NY切换控制器图1.10飞行工作任务分布状态工作流程经过以上研究分析，想展开平稳的转换，仅有当四旋翼无人机在稳定悬停实际状况下姿态角与线速率都接近于零时才满足转换基本条件，完成操作控制量的平稳过渡转化。1.6无人机目标定位与自动导航控制算法控制操作设备转换后全面进入自主独立登陆时期，因为根据视觉图像处理数据信号的自主独立登陆操作控制要求符合使用视觉图像处理数据信息创造的既定限制。图1.11为根据视觉图像处理自动导航的自主独立登陆操作控制框架示意图，图里视觉图像处理体系获取登陆场和无人操控机的相对具体位置数据信息，因为视觉图像处理体系获取数据信号有延迟作用，因此要求预计控制器设备把视觉图像处理数据信息全面处理（xVyVzV）再展开登陆运动轨迹策划获取希望的操作控制数据信号，实现了自主独立登陆工作任务。QUOTE任务规划车载起降模块外环控制器内环控制器任务规划车载起降模块外环控制器内环控制器无人机Prψrθrɸr𝝳预测器视觉系统xvzvyn图1.11根据视觉图像处理自动导航的自主独立登陆操作控制框架示意图图1.11里的外环控制操作设备里横竖直方向操作控制律例