四轴飞行器运动控制系统设计.doc
《四轴飞行器运动控制系统设计.doc》由会员分享,可在线阅读,更多相关《四轴飞行器运动控制系统设计.doc(67页珍藏版)》请在沃文网上搜索。
1、摘 要 旋翼式飞行器因其起飞和降落所需空间较少,在障碍物密集环境下的操控性较高,以及飞行器姿态保持能力较强的优点,在民用和军事领域都有广泛的应用前景。其中,小型四旋翼飞行器的研究近年来日趋成熟,并为自动控制,先进传感技术以及计算机科学等诸多技术领域的融合研究提供了一个平台。在空中机器人智能控制,三维路径规划,多飞行器空中交通管理和碰撞规避等方面,小型四旋翼飞行器控制系统都具有很高的研究价值。 四轴飞行器具有不稳定、非线性、强耦合等特性, 姿态控制是四轴飞行器飞行控制系统的核心; 通过分析四轴飞行器的飞行原理, 根据其数学模型和系统的功能要求, 设计了四轴飞行器的姿态控制系统;该系统由以无刷直流
2、电机为动力核心的动力驱动系统、以微控制器及陀螺仪为核心的核心控制系统、以2.4 GHz的无线遥控接收器为核心的无线遥控控制系统组成。采用脉冲宽度调制信号控制四旋翼控制动力驱动模块。通过对四旋翼工作模式与控制参数的研究,得到相应的控制算法,然后编程实现、模拟相应的飞行姿态。关键词:脉冲宽度调制;陀螺仪;姿态控制;无刷直流电机Abstract Rotary-wing air-crafts have many military and civilian applications due to their requiring small areas for taking off and landing
3、, great maneuverability in Obstacle-heavy environment and great ability to maintain the position and orientation.The research of small scale quad rotors, one kind of rotary wing air-crafts, have gradually become mature in recent years, and also provided an important platform for investigations in su
4、ch fields as the autonomous control, advanced sensor technology and computer science. Investigations on the control system of small scale quad rotor proved to be of high value in such applications as intelligent control of the aerial robot,3D trajectory planning and the air traffic management and co
5、llision avoidance of mufti aircraft . Quad-rot or is a complex system with instability, non-lin ear and high coupling. The attitude control system is the key of quad rotor. The flight theory of quad rotor is analyzed firstly. Based on the math emetical model and flight control requirement , the atti
6、tude control system of quad rot or is proposed. Fourrotor aircraft system mainly includes drive system composed by brushless DC motors,master control system composed by the micro-controller and gyroscopes and wireless remote control system composed by the 24 GHz wireless remote control receiverFirst
7、ly,the author uses the PWM (Pulse Width Modulation)signal produced by MCU to drive the control moduleSecondly,after the analysis of fourrotor aircraft,the author studies control parameters and achieves the corresponding control algorithmThirdly,the author programme to simulate the corresponding flig
8、ht attitudeKey words:pulse width modulation;gyro scop;attitude control;brushless DC motors 目录 摘 要IAbstractII第一章 概述11.1 引言11.2 本课题的国内外的研究现状11.3 本文的主要内容31.4 本章小结3第二章 总体方案设计42.1 四轴飞行器运动控制系统的基本工作原理42.2 四轴飞行器控制系统结构52.3 本章小结7第三章 硬件设计83.1 概述83.2 主控制器的选择83.3 信息采集143.3.1 加速度传感器与陀螺仪143.3.2 数字罗盘173.4 无线通讯203.5
9、 电机驱动253.5.1 无刷电机253.5.2 PWM调速263.5.3 可控开关的选择263.6 供电电路293.6.1 电池选择293.6.2 电压变换器的选择293.7 本章小结31第四章 控制算法324.1 标定加速度324.2 姿态结算344.3 融合算法354.4 控制算法384.5 本章小结405.1 STM32F103T8U6的端口分配415.2 流程设计435.3 无线通讯455.4 控制计算485.5 本章小结50第六章 设计总结51参考文献52致谢65III第一章 概述1.1 引言 四旋翼作为一种具有结构特殊的旋转翼无人飞行器。与固定翼无人机相比,它具有体积小,垂直起降
10、,具有很强的机动性,负载能力强,能快速、灵活地在各个方向进行机动,结构简单,易于控制,且能执行各种特殊、危险任务等特点。 因此在军用和民用领域具有广泛的应用前景如低空侦察、灾害现场监视与救援等。多旋翼无人机飞行原理上比较简单,但涉及到的科技领域比较广,从机体的优化设计、传感器的算法、软件及控制系统的设计都需要高科技的支持。虽然国内的一些研究机构已经在进行多旋翼飞行器的研究,但大多数还是停留在理论探讨与模拟的阶段,缺乏多旋翼机硬件与控制上自己的核心技术与经验,无法得到满意的飞行性能,在国内至今尚未有高性能的多旋翼无人机研制成功的报道。现在国内一些对该类无人机有需求的机构都是花高价从国外购买,每架
11、成本在20万到40万人民币之间。本课题针对四旋翼无人机进行研究,它的研究将有利于打破多旋翼无人机技术欧美日垄断的局面,推动中国多旋翼无人机的研究发展,为无人机在气象、防灾、环境保护、侦查追踪等民用警用领域实现产业化作出贡献。廉价高性能的无人机的研究将会带来巨大的经济效益,同时可以推动关联科研项目的发展,为我国的科研事业做出巨大贡献。 四旋翼无人机的飞行控制技术是无人机研究的重点之一。它使用直接力矩, 实现六自由度(位置与姿态)控制,具有多变量、非线性、强耦合和干扰敏感的特性。此外, 由于飞行过程中,微型飞行器同时受到多种物理效应的作用,还很容易受到气流等外部环境的干扰,模型准确性和传感器精度也
12、将对控制器性能产生影响,这些都使得飞行控制系统的设计变得非常困难。而作为微型飞行平台自主导航的基础姿态稳定控制(内回路控制) ,其控制结果对微型飞行平台飞行特性的影响至关重要,因此姿态控制是整个飞行控制的关键。微小型四旋翼飞行器的姿态与位置存在直接耦合关系(俯仰和横滚直接引起机体向前后左右移动) ,如果能精确控制飞行器姿态,则采用一般控制律就足以实现其位置与速度控制。因此,研制既能精确控制制飞行器姿态,又具控有较强抗干扰和环境自适应能力的姿态控制器是微小型四旋翼飞行器飞行控制系统研究的当务之急。1.2 本课题的国内外的研究现状早在上个世纪中叶,多旋翼飞行器就已经受到了海外一些研究机构的瞩目。多
13、旋翼飞行器虽然机械构造与飞行原理都很简单,但对传感器类与控制理论上的要求非常高,所以一直到本世纪初期,MEMS传感器技术及嵌入式控制系统科技的高速发展使得多旋翼无人机的研究终于得到了突破。特别是欧美的一些先进国家,在小型,超小型无人机研究领域中,多旋翼无人机已逐步取代直升机式无人机,成为旋翼无人机研究的主流。欧美据有代表性的科研团队有美国的MIT,德国的Ascending Technology,法国的Hesychastic,美国的Pennsylvania等。作为产品来开发的主要有Micro Drones,Dragonfly,Micropterous等企业。这些团队与企业早在本世纪初期就已经着手
14、于多旋翼无人机的研究开发,分别在06,07年前后研发出各自的新型机体,并在市场上开始了贩卖。其中Micro drones的产品性能最为稳定,价格也最为昂贵,最低档的产品也要在40万人民币左右。缺点是因为采用的是低转速的电机,抗风能力弱,载重能力较差,只能搭载200g以下的数码相机,很难搭载其他的传感器来执行任务。Dragonfly虽然是最早推出产品的公司,但他们的产品在机动性与抗风性上始终没能让客户感到满意。Micropterous公司走的是DIY路线,供应散件让用户自己组装,同时在网上公布一部分电路图与程序源代码。虽然在驱动与控制上都存在着许多缺陷,但因为成本低,受到了广大爱好者的青睐。中国
15、国内流传的4浆飞行器基本上都是Micropterous的复制品。海外的科研团队除了在飞行控制上持续着深入的探讨之外,近期已把大部分的精力投入到智能飞行上。目标是实现无人机的室内室外自由飞行,以便执行一些比较复杂的例如解救人质的任务。近两年,多旋翼无人机的研发步伐日益加快,德国与美国的警察局都已将配备多旋翼机列入日程。日本也计划在明年将开发的6浆飞行器产业化,用于喷洒农药。中国国内对多旋翼无人机的开发起步较晚,至今仍然远落后于欧美与日本。代表性的机构有南航、北航、国防科技大学、中南大学、吉林大学等。大多数的无人机科研机构至今仍然停留在理论探讨及模拟上。南航、北航等少数科研机构虽制作出了样机,但因
16、缺乏多旋翼机控制上的核心技术与经验,无法得到满意的飞行性能,至今尚未有性能稳定的多旋翼无人机研制成功的报道。因德国的Micropterous公司在网上公开了源程序代码,一些民间企业就模仿Micropterous制作了产品在网上贩卖,但因没有自己的技术支持,虽售价远低于欧美的同类产品,但性能低劣,无任何实用价值。随着科技的发展,无人机的应用领域已逐渐从军用过渡到民用,警用。低造价,高飞行性能的多旋翼无人机无疑会对这个过渡起到一个极大的推动作用。无论在气象勘测,灾情调查,环境保护等民用领域,还是针对追捕逃犯,瓦解恐怖活动等的警用领域,都有着很大的需求空间。各界人士已经提出了对多旋翼无人机的期待希望
17、未来的几年,国内对多旋翼无人机的研发能够取得突破,研发出中国自己的高性能无人机。1.3 本文的主要内容本设计主要通过单片机采集3轴加速度传感器和3轴陀螺仪对飞行器的姿态进行检测,控制4个微型高速无刷电机带动旋翼旋转,实现飞行器的悬停、升降、前后左右移动、以及旋转,通过2.4G无线通讯模块实现远程遥控。内容涉及数学建模、自动控制理论、无刷电机驱动、传感器技术等学科领域。完成了四旋翼飞行器数学模型的建立,飞行控制系统的总体方案设计,软硬件设计,控制算法。1、设计实现的主要功能: 1)通过加速度传感器识别飞行器倾斜状态并控制实现水平;2)通过陀螺仪传感器识别飞行器是否自旋并控制姿态;3)控制4个无刷
18、电机实现飞行器运动;4)通过2.4G无线通讯模块与上位机进行通讯接收命令。2、主要技术指标1)系统工作电压DC4.2V:2)工作温度-30-60。3)飞行时间10分钟。1.4 本章小结 本章介绍了四轴飞行器背景、国内外的研究现状,以及设计所实现的主要功能和技术指标。 第二章 总体方案设计 四旋翼飞行器是一种布局形式比较新颖的飞行器,其结构较为紧凑。四旋翼飞行器主要是通过改变4 个电机的转速来调节螺旋桨转速,由旋翼升力的变化实现对飞行器的控制。四旋翼飞行器由于能够垂直起降,自由悬停,可适应于各种速度及各种飞行剖面航路的飞行状况。2.1 四轴飞行器运动控制系统的基本工作原理 电机1和电机3逆时针旋
19、转的同时,电机2和电机4顺时针旋转,因此当飞行器平衡飞行时,陀螺效应和空气动力扭矩效应均被抵消。 各个旋翼对机身所施加的反扭矩与旋翼的旋转方向相反,因此当电机1和电机3逆时针旋转的同时,电机2和电机4顺时针旋转,可以平衡旋翼对机身的反扭矩。四旋翼飞行器在空间共有6个自由度(分别沿3个坐标轴作平移和旋转动作),这6个自由度的控制都可以通过调节不同电机的转速来实现。 图2-1 运动控制原理图 飞行器在三维空间中具有6个运动自由度包括3个坐标轴方向的线运动和3个坐标轴方向的角运动。上下的平移运动是通过4个电机同时增速(减速)得到的, 当4个电机的升力之和等于飞行器的自重时,飞行器便保持悬停。水平面内
20、的前后运动是电机1、2增速(减速)的同时电机3、4减速(增速),此时保持旋翼1、3对机身的反扭矩等于旋翼2、4对机身的反扭矩,在电机1、2与电机3、4的升力之差作用下机身发生倾斜,得到水平面内的前后运动。俯仰运动是通过电机1、3转速保持不变,电机2增速(减速)的同时, 电机4减速(增速)得到的。以类似的方法,滚转运动是通过改变电机1、3转速得到的。偏航运动是电机1、3增速(减速) 的同时,电机2、4减速(增速),此时旋翼1、3对机身的反扭矩大于(小于)旋翼2、4对机身的反扭矩,机身便在多余扭矩的作用下得到偏航运动。组合以上的基本运动可以实现四旋翼微型飞行器的各种复杂运动。2.2 四轴飞行器控制
21、系统结构 本四轴飞行器控制系统主要实现人的遥控操作及自动增稳功能。飞行器通过接收机接收到的遥控指令完成操作者的遥控操作,同时具有感知飞行姿态并自动调整的功能。整个控制系统包括电源模块、无线通讯模块、传感器模块、电机驱动模块、控制器模块。无线收发模块接受遥控器传来的控制信号,然后将控制信息传送给控制器模块。传感器模块采用三轴加速度传感器、陀螺仪实时监测飞行器飞行的实际姿态,并将飞行器的实际姿态数据传送给控制器模块。控制器模块接收到传感器模块和无线通讯模块传来的目标姿态数据和实际姿态数据后,完成一系列复杂的算法,得到四旋翼飞行器的姿态和位置信息,计算出控制量,转化为相应的PWM信号经驱动电路后驱动
22、四个电机工作,保持四旋翼飞行器稳定飞行,并将遥测信息通过无线通讯模块传送到地面控制站。无线通讯模块无线通讯模块主控制器姿态测量系统姿态解算控制计算加速度传感器陀螺仪数字罗盘 电机驱动图2.2 系统框架图 1、姿态测量系统:四轴飞行器飞行器在某个时刻的状态由6个物理量来描述,包括在三维坐标中的3个位置量和沿3个轴的姿态量(即称为六自由度)。传感器作为一种检测装置,能感受到被测量的信息,并能将检测感受到的信息,按一定规律变换成为电信号或其他所需形式的信息输出,以满足信息的传输、处理、存储、显示、记录和控制等要求。它是实现自动检测和自动控制的首要环节。因此传感器模块是为四旋翼飞行器的飞行控制提供各种
23、飞行参数的装置,包括测量机身三轴角速率的陀螺仪、测量机身三轴线加速度的加速度计、测量机身航向及姿态信息的罗盘等。在测量过程中由于陀螺仪存在温漂和数字罗盘受周围磁场的影响,导致测得的姿态信息并不准确,因此将陀螺仪、加速度计和数字罗盘结合起来获取准确的偏航角、滚转角、俯仰角信息。 加速度传感器:加速度传感器用于测量机身相对于水平面的倾斜角度,利用了地球万有引力,把重力加速度投影到X,Y,Z轴上,测量出物体的姿势。 陀螺仪:利用旋转物体的旋转轴所指的方向在不受外力影响时的不变性,测量外力对物体的影响。跟地球万有引力和地球南北极的磁力具有固定方向性不同,旋转物体的旋转轴方向是不确定的,因而角速度传感器
- 1.请仔细阅读文档,确保文档完整性,对于不预览、不比对内容而直接下载带来的问题本站不予受理。
- 2.下载的文档,不会出现我们的网址水印。
- 3、该文档所得收入(下载+内容+预览)归上传者、原创作者;如果您是本文档原作者,请点此认领!既往收益都归您。
下载文档到电脑,查找使用更方便
20 积分
下载 | 加入VIP,下载更划算! |
- 配套讲稿:
如PPT文件的首页显示word图标,表示该PPT已包含配套word讲稿。双击word图标可打开word文档。
- 特殊限制:
部分文档作品中含有的国旗、国徽等图片,仅作为作品整体效果示例展示,禁止商用。设计者仅对作品中独创性部分享有著作权。
- 关 键 词:
- 飞行器 运动 控制系统 设计