CN103365295B - 基于dsp的四旋翼无人飞行器自主悬停控制系统及方法 - Google Patents

基于dsp的四旋翼无人飞行器自主悬停控制系统及方法 Download PDF

Info

Publication number
CN103365295B
CN103365295B CN201310272189.5A CN201310272189A CN103365295B CN 103365295 B CN103365295 B CN 103365295B CN 201310272189 A CN201310272189 A CN 201310272189A CN 103365295 B CN103365295 B CN 103365295B
Authority
CN
China
Prior art keywords
control
module
rotor unmanned
manual
dsp
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Active
Application number
CN201310272189.5A
Other languages
English (en)
Other versions
CN103365295A (zh
Inventor
鲜斌
赵勃
黄国平
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Tianjin University
Original Assignee
Tianjin University
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Tianjin University filed Critical Tianjin University
Priority to CN201310272189.5A priority Critical patent/CN103365295B/zh
Publication of CN103365295A publication Critical patent/CN103365295A/zh
Application granted granted Critical
Publication of CN103365295B publication Critical patent/CN103365295B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Abstract

一种基于DSP的四旋翼无人飞行器自主悬停控制系统及方法,控制系统有分别设置在四个机翼上的四个螺旋桨和控制单元,控制单元是:主控制单元通过无线网络连接地面计算机,接收机与信号转换模块和手动/自动切换芯片依次连接,将接收到的遥控器所发出的信号通过信号转换模块送入手动/自动切换芯片,接收机还通过主控制单元连接手动/自动切换芯片,将接收到的信号通过主控制单元送入手动/自动切换芯片,用于控制驱动单元驱动四个螺旋桨上的直流无刷电机工作。方法有对声纳数据进行卡尔曼滤波处理获得准确的高度数据和驱动器控制。本发明能够有效增强了微小型四旋翼无人飞行器的自主飞行能力和对环境的适应能力,可完成室内环境和室外环境下自主飞行控制。

Description

基于DSP的四旋翼无人飞行器自主悬停控制系统及方法
技术领域
[0001] 本发明设及一种无人飞行器自主悬停控制方法。特别是设及一种基于DSP的四旋 翼无人飞行器自主悬停控制系统及方法。
背景技术
[0002] 无人飞行器是指无人驾驶、自主推进,通过无线电遥控或者自身程序控制,利用空 气动力承载飞行并且可回收重复利用的飞行器。它凭借自身的优势和特点,在多个领域获 得了广泛应用。在军事方面,无人飞行器的主要用途包括地面战场侦察、获取敌方情报、近 距离控制巡逻、监视、电子战、地面通信等;在民用方面,无人飞行器的使用范围也相当广 泛,例如航拍和图像传输,巡逻监视和目标跟踪,自然灾害发生之后的捜索和救援,高压线、 桥梁、水巧和地震后路段的检查等。无人飞行器根据其机翼的类型可W分为固定翼无人飞 行器和旋翼式无人飞行器。其中,旋翼式无人飞行器具有广阔的发展前景,因为它具有固定 翼无人飞行器无法比拟的优势;体积小,轻便灵活;结构简单,耗能低;能够自主起飞和降 落;适应各种环境,在障碍物密集环境下的可控性强;保持飞行姿态的能力较强,并且能W 多种姿态进行飞行,包括悬停、前飞、倒飞和侧飞等飞行姿态。近几年,四旋翼无人飞行器已 经成为了控制领域的研究热点(期刊:中国科学技术大学硕±学位论文;著者;庞庆霜;出 版时间;2011年;文章题目:四旋翼飞行器设计与稳定控制研究;页码;15-20)。
[0003] 目前国内外许多高校和研究机构开展了四旋翼无人飞行器系统控制领域的研究 工作,比较有代表性的成果包括;(1)瑞±洛桑联邦科技学院(EPFL)的自动化系统实验开 发了 0S4平台,该平台使用化aganflyer公司的旋翼和十字框架,采用4个Fau化油er的电 机,机载传感器有惯性测量单元(IMU)、声纳传感器和视觉系统,通过地面站计算机作为控 制器,完成飞行控制任务。他们研究的重点在于结构设计和自主飞行控制算法(期刊:长春 理工大学硕±学位论文;著者;郑伟光;出版时间;2010年;文章题目:四旋翼无人飞行器 飞行姿态控制系统研究;页码;1〇-17) ; (2)美国宾夕法巧亚大学的研究小组,搭建的室内 四旋翼无人飞行器机体采用了AscendingTechnologies公司的Hummingbird型号本体,有 效载荷为0.化g,采用了Vicon视觉定位系统,由地面站进行数据采集、运行控制算法和发 送控制指令。目前,该研究小组已在四旋翼无人飞行器室内视觉定位、轨迹规划W及多机协 同等方面取得了一定的研究成果。但是,该平台存在一定的局限,主要是载重小,只能在室 内环境下飞行(其月干。:IEEEInternationalConferenceonRoboticsandAutomation;著 者;S.Shen,N.Michael,V.Kumar;出版时间;2011 年;文章题目;AutonomousMulti-Floor Indoor^vigationwithaComputationallyConstrainedMAV,页码;20-25) ; (3)中国 国防科技大学的研究人员自行设计制作了四旋翼无人飞行器机体和基于单片机作为控制 单元的机载控制系统,并在仿真中实现了较好的控制效果(期刊;中国国防科技大学硕±学 位论文;著者;王俊生;出版时间;2007年;文章题目:四旋翼蝶形飞行器控制系统设计及 控制方法研究;页码;12-22)。
发明内容
[0004] 本发明所要解决的技术问题是,提供一种能够充分发挥机载传感器及自行设计飞 行控制算法作用,有效增强了微小型四旋翼无人飞行器的自主飞行能力和对环境的适应能 力,可完成室内环境和室外环境下自主飞行控制的基于DSP的四旋翼无人飞行器自主悬停 控制系统及方法。
[0005] 本发明所采用的技术方案是:一种基于DSP的四旋翼无人飞行器自主悬停控制系 统,包括有四旋翼机体、分别设置在四个机翼上的四个螺旋奖W及控制四个螺旋奖旋转的 控制单元,所述的控制单元包括有;主控制单元、地面计算机、接收遥控器信号的接收机、信 号转换模块、手动/自动切换巧片W及用于驱动四个螺旋奖上的直流无刷电机工作的驱动 单元,所述的主控制单元通过无线网络连接地面计算机,所述的接收机与信号转换模块和 手动/自动切换巧片依次连接,将接收到的遥控器所发出的信号通过信号转换模块送入手 动/自动切换巧片,用于控制驱动单元驱动四个螺旋奖上的直流无刷电机工作,所述的接 收机还通过主控制单元连接手动/自动切换巧片,将接收到的信号通过主控制单元送入手 动/自动切换巧片,用于控制驱动单元驱动四个螺旋奖上的直流无刷电机工作。
[0006] 所述的驱动单元包括有四个电子调速器,所述的四个电子调速器的输入端分别连 接手动/自动切换巧片的输出端,所述四个电子调速器的输出端分别对应连接四个螺旋奖 上的直流无刷电机。
[0007] 所述的主控制单元包括有机载主控制器,所述的机载主控制器分别连接上位机、 机载传感器和无线数传模块,所述的上位机还连接声纳传感器,其中,所述的机载主控制器 分别连接接收机和手动/自动切换巧片用于控制驱动单元驱动四个螺旋奖上的直流无刷 电机工作,所述的机载主控制器通过无线数传模块和无线连网络接地面计算机,所述的上 位机通过无线连网络接地面计算机。
[000引一种基于DSP的四旋翼无人飞行器自主悬停控制系统的控制方法,包括;对声纳 数据进行卡尔曼滤波处理获得准确的高度数据和驱动器控制,其中,驱动器控制包括如下 步骤:
[0009] 1)系统初始化操作;
[0010] 2)在系统完成初始化后,各接口开始与外部设备进行通信,其中,串口SCIB与机 载传感器MTi-G连接,读取和验证MTi-G发送过来的姿态位置信息;串口SCIC与无线数传 模块连接,通过无线数传模块的传输功能与地面站进行数据通信;SPI接口与ARM模块进行 通信,获得由ARM模块读取并经过滤波算法处理的声纳数据,并将无人机全部的实时飞行 数据快速地发送至ARM模块;
[0011] 3)根据各个传感器的数据和飞行轨迹规划指令,对程序中定义的实际飞行位置姿 态变量和期望飞行位置姿态变量进行初始化;
[0012] 4)进入飞行控制算法部分,使用经典PID算法,结合步骤2)读取到的数据,计算得 到四个直流无刷电机的转速值,直接控制输入量;
[0013] 5)DSP的PWM模块将电机转速值解算生成具有一定脉宽的PWM信号,输出至高速 电子调速器,驱动电机转动产生相应的转速,使得四旋翼无人飞行器完成自主悬停控制。
[0014] 所述的对声纳数据进行卡尔曼滤波是应用Kalman基本滤波方程式,有:
[0015]
Figure CN103365295BD00061
[0019] 其中,而托=1.2.'',)为k时刻的状态估计,Q为非负定的系统噪声方差阵,Pk/k_i为一 步预测均方误差,Pk为估计均方误差,R=r,Hk=H,Kk为滤波增益,Zk为tk时刻的量测量,r =[0 0T]T为系统噪声驱动阵,
Figure CN103365295BD00062
%tk_i时刻到tk时刻的一步转移阵,I为单 位矩阵。
[0020] 步骤4)所述的计算得到四个直流无刷电机的转速值,是采用MTLAB的nlinfit 函数来对转速曲线进行非线性拟合;nlinfit函数是基于最小二乘法对模型的参数进行估 计,采用牛顿迭代算法,拟合结果为
[0021] y= -58441x'+87159x-458741
[002引式中,X为PWM信号占空比,y为电机转速。
[0023] 本发明的基于DSP的四旋翼无人飞行器自主悬停控制系统及方法,具有如下优 点:
[0024] 1,硬件平台成本低,且配件易于更换。市面上的四旋翼飞行器整机不仅价格昂贵, 且配件的兼容能力很差。本发明采用市面上使用广泛、价格低廉且货源充足的配件自主集 成整套飞行器系统,既可确保飞行器满足基本的性能指标,又可保证多台飞行器在性能上 的一致性。
[0025] 2,充分掌握控制器的架构与算法。商业四旋翼飞行器整机往往封锁底层控制方 法,不留或只留少数接口供用户使用,给二次开发带来不便。本发明的控制器电路及器件连 接为全自主设计,便于升级改进,可使飞行器控制方法更为灵活丰富。
[0026] 3,采用上下两层控制器架构。该样既保证了底层控制器的实时与高效,又能满足 顶层复杂任务的实施与交互,并有效地节省了开发周期。
[0027] 4,采用非线性控制算法,有较强的鲁椿性。由于四旋翼无人飞行器的动力学模型 为非线性数学模型,采用非线性控制算法能很好地补偿动力学系统中的非线性特性,可较 传统的线性控制方法获得更好的控制效果。
[002引实验结果表明,本发明具有成本低、结构简单、可扩展性好、控制精度高等优点。
附图说明
[0029] 图1是本发明基于DSP的四旋翼无人飞行器自主悬停控制系统框图;
[0030] 图2是基于DSP的四旋翼无人飞行器自主悬停控制系统结构示意图;
[0031] 图3是本发明的控制流程图;
[0032] 图4a是声纳传感器滤波前的原始数据;
[0033] 图4b是声纳传感器滤波后的数据;
[0034] 图5a是自主悬停时的滚转角(roll)变化曲线图;
[0035] 图化是自主悬停时的俯仰角(pitch)变化曲线图;
[0036] 图5c是自主悬停时的偏航角(yaw)变化曲线图;
[0037] 图6a是自主悬停时的滚转角速率(gyrx)变化曲线图;
[003引图化是自主悬停时的俯仰角速率(gyry)变化曲线图;
[0039] 图6c是自主悬停时的偏航角速率(gyrz)变化曲线图;
[0040] 图7a是自主悬停时的高度(Z)变化曲线图;
[0041] 图化是自主悬停时的高度速率(VelocityZ)变化曲线图。
[0042] 图中
[00创 1;四旋翼机体 2;螺旋奖
[0044] 3 ;控制单元 31 ;主控制单元
[0045] 32 ;地面站计算机 33 ;接收遥控器
[0046] 34 ;接收机 35 ;信号转换模块
[0047] 36;手动/自动切换巧片37;驱动单元
[0048] 311 ;机载主控制器 312 ;上位机
[0049] 313;机载传感器 314;无线数传模块
[0化日]315;声纳传感器 371;电子调速器
具体实施方式
[0化1 ] 下面结合实施例和附图对本发明的基于DSP的四旋翼无人飞行器自主悬停控制 系统及方法做出详细说明。
[0052] 如图1、图2所示,本发明的基于DSP的四旋翼无人飞行器自主悬停控制系统,包括 有四旋翼机体1、分别设置在四个机翼上的四个螺旋奖2W及控制四个螺旋奖2旋转的控制 单元3。
[0053] 1.四旋翼机体1是综合考虑飞行器机体的结构稳固性、负载能力、续航能力、可 控性等特点要求,采用四旋翼无人飞行器。机身直径为450mm,高度为111mm;空机重量为 750g(不含接收机和电池),载重重量为750g,最大安全起飞总重量为1500g;螺旋奖直径为 25. 5cm,单个电机提供的最大推力为8N;电源可采用11.IV(3S) 2200mAh-5500mAh的裡电 池供电,在起飞重量为1200g时,使用3S3300mAh的裡电池的飞行时间大约为12min;集成 了设备承载板,可方便地安装控制器等机载设备;最多可支持12通道的接收机,飞行至少 需要4个通道,为了便于扩展,本发明使用的是7通道的遥控设备。
[0054]作为四旋翼无人飞行器的执行器,直流无刷电机采用电子调速器(ESO驱动。电子 调速器接收的PWM信号的工作频率设置为430Hz,周期为2. 33ms,信号的高电平为2. 7V-6V, 有效控制脉宽为1.lms-1. 9ms,即小于1. 1ms的脉宽将不能启动无刷电机,大于1. 9ms的脉 宽将被视为1. 9ms,只有在有效控制脉宽范围内的PWM信号才能调节无刷电机转速。
[0化5] 2.所述的控制单元3包括有:主控制单元31、地面站计算机32、接收遥控器33信 号的接收机34、信号转换模块35、手动/自动切换巧片36W及用于驱动四个螺旋奖2上的 直流无刷电机工作的驱动单元37,所述的主控制单元31通过无线网络连接地面站计算机 32,所述的接收机34与信号转换模块35和手动/自动切换巧片36依次连接,将接收到的 遥控器33所发出的信号通过信号转换模块35送入手动/自动切换巧片36,用于控制驱动 单元37驱动四个螺旋奖2上的直流无刷电机工作,所述的接收机34还通过主控制单元31 连接手动/自动切换巧片36,将接收到的信号通过主控制单元31送入手动/自动切换巧片 36,用于控制驱动单元37驱动四个螺旋奖2上的直流无刷电机工作。
[0056] 所述的驱动单元37包括有四个电子调速器371,所述的四个电子调速器371的输 入端分别连接手动/自动切换巧片36的输出端,所述四个电子调速器371的输出端分别对 应连接四个螺旋奖2上的直流无刷电机。
[0化7]所述的主控制单元31包括有机载主控制器311,所述的机载主控制器311分别连 接上位机312、机载传感器313和无线数传模块314,所述的上位机312还连接声纳传感器 315,其中,所述的机载主控制器311分别连接接收机34和手动/自动切换巧片36用于控 制驱动单元37驱动四个螺旋奖2上的直流无刷电机工作,所述的机载主控制器311通过无 线数传模块314和无线连网络接地面站计算机32,所述的上位机312通过无线连网络接地 面站计算机32。
[0化引 1)机载主控制器311,作为四旋翼无人飞行器的核屯、组成部分机载主控制器311 的选型和设计需要充分考虑四旋翼无人飞行器的特点。因此,本发明中的机载控制巧片应 满足W下要求;供电要求简单、功耗低、体积小、重量轻、运算速度快、外设接日丰富等。本发 明选择TI公司的TMS32CF28335作为机载主控制器311。TMS32CF28335是一款32位的浮 点DSP,主频为150MHz;集成了快速的中断管理单元,满足实时控制的需求;片上整合了丰 富的外设资源,包括Flash存储器、快速的A/D转换器、串行通信接口、增强捕获单元、PWM模 块、CAN模块、多通道缓冲串口等。
[0化9] 在本发明中,作为机载主控制器311的DSP承担的任务有;运行控制算法程序;通 过RS232串口与机载传感器连接进行数据采集;通过SPI接口与上位控制器模块进行数据 通讯;利用无线数传模块与地面站进行数据通讯;输出PWM信号驱动作为四旋翼无人飞行 器驱动器的无刷直流电机;读取遥控器各通道信号,实现手自动飞行模式的切换。结合四旋 翼无人飞行器的整体结构,参照上述的各功能模块,并考虑DSP最小系统板所必须的电源 模块、JTAG模块、RESET模块、时钟源模块、启动模式模块等外围电路模块,设计制作了基于 DSP的机载主控制器模块。
[0060] 2)上位机312,本发明使用了一块ARM控制器作为上位机312。主频为720MHz,采 用嵌入式Linux操作系统,存储器包含了 512MB的RAM和512MB的Flash,主巧片上有WIFI 和Bluetooth两种无线通信方式,扩展板上集成了USB接口、SD卡插槽、RS232串口、I化接 口、音频输入输出接口、HDffl视频接口等接口。作为上位机,ARM模块的主要功能是通过I2C 接口与声纳传感器连接,连续地从声纳传感器中读取数据,然后运行数据融合算法将原始 数据处理成四旋翼无人飞行器的高度信息,并通过SPI接口传输至机载主控制器。此外,机 载主控制器能够通过SPI接口向ARM模块发送四旋翼无人飞行器实时的状态信息,该些状 态信息通过WIFI传送至地面站,可实时地监测飞机的飞行状态,也能够保存下来用于实验 后续的数据分析处理。
[0061] 3)机载传感器313和声纳传感器315,本发明中的四旋翼无人飞行器使用的机载 传感器是荷兰Xsens公司的MTi-G传感器,使用的声纳传感器是Devantech公司的SRF-08 声纳传感器。
[0062] MTi-G是一个集成了GI^S信号的微型姿态航向参考系统,内部集成了3维加速度 计、速度计、磁力计、气压计、温度计、电子罗盘,可输出3轴姿态、航向、位置和速度等信息, 俯仰角和滚转角精度为0. 5°,偏航角精度为r。MTi-G通过RS232串口与机载主控制器 DSP进行数据通信。
[006引SRF-08声纳传感器采用5V的供电电压,工作电流约为15mA,通过I2C接口与处理 器连接,最小测量距离为3畑1,最大测量距离为6m,外形尺寸为40mmX 20mmX 17mm,重量为 11.3g。声纳传感器通过I2C总线与ARM模块进行数据通信,在通讯过程中,将ARM模块设 为主设备,而将声纳传感器设为从设备。
[0064] 4)无线数传模块314,无线数传模块在四旋翼无人飞行器实验平台与地面站计算 机间建立了一条快捷方便的数据通道。通过无线数传模块不仅可W实现由四旋翼无人飞行 器向地面站发送飞机的状态信息,而且能够实现通过地面站在线调节四旋翼无人飞行器的 飞行控制算法参数,从而避免了频繁往机载主控制器烧写控制算法程序的麻烦,明显缩短 了实验周期。本发明选用一款半双工微型无线数传模块,分为发射端和接收端,发射端通过 RS232串口与机载主控制器连接,接收端通过USB接口与地面站计算机连接。其功能特点 有;发射功率为500mW;体积为53mmX38mmX10mm(不包括天线接头);传输距离约为2Km; 采用半双工的通信方式。
[00化]本发明的基于DSP的四旋翼无人飞行器自主悬停控制系统的工作过程:
[0066] 如图1所示,左半部分为四旋翼无人飞行器的手动遥控信号通路,由遥控信号发 射机、信号接收机和信号转换模块=个部分构成。飞行时,遥控信号发射机(即遥控器)向接 收机发送PPM形式的遥控通道信号。接收机通过译码电路将接收到的PPM信号翻译成PWM 信号后,传递至信号转换模块,最终由它转换产生驱动4路高速电子调速器的PWM信号,进 而驱动直流无刷电机转动。
[0067] 如图1所示,右半部分为四旋翼无人飞行器的自动控制部分。微型姿态航向参考 系统MTi-G可实时测量四旋翼无人飞行器的姿态和位置数据。该些数据通过RS232串口发 送至机载主控制器DSP。声纳传感器数据是通过ARM模块的I化接口读取,经过滤波处理后, 将准确的高度信息通过SPI接口发送给DSP。然后,DSP运行控制算法,并将控制量转换成 能够驱动电机的PWM信号,输出给高速电子调速器。四旋翼无人飞行器的飞行数据可通过 AM模块的WIFI模块实现大批量快速地传送至地面站计算机进行显示和存储;也可W借助 无线数传模块实现四旋翼无人飞行器与地面站计算机之间部分数据的传输和控制参数的 在线调节。
[0068] W上的手动控制信号和自动控制信号是通过CD4053巧片(图1中手动/自动切换 巧片)来进行选通切换的。
[0069] 本发明的的基于DSP的四旋翼无人飞行器自主悬停控制系统的控制方法,包括: 对声纳数据进行卡尔曼滤波处理获得准确的高度数据和驱动器控制,其中,
[0070] 1.所述的对声纳数据进行卡尔曼滤波是:
[0071] 作为四旋翼无人飞行器的高度传感器,虽然SRF-08声纳传感器可测量得到较高 精度的高度数据,但是它在使用中容易受到干扰,测得的原始数据包含的噪声较多,误差较 大,无法直接用于四旋翼无人飞行器的高度控制。因此,本发明在ARM模块中设计了一个卡 尔曼滤波器,来对声纳传感器的原始数据进行滤波处理,可得到较为准确的高度数据。
[0072] 假设四旋翼无人飞行器沿垂直方向直线运动,tk时刻的位移、速度、加速度和加 加速度分别为Sk、Vk、ak和jk;只对运动物体的位置做观测,观测的采样周期为T;对运动物 体的跟踪者来说,加加速度jk是随机量,此处取为白噪声,根据运动学方程,系统状态方程 为:
[007引 Xk=巫Xk-1+rjk-i(1)
[0074] 观测方程为;
[007引 Zk=Sk+Vk=H品+Vk似
[0076] 其中定义Xk= [Sk VkajT为状态向量
Figure CN103365295BD00101
为tk_i时刻到tk时刻的一 步转移阵;Zk为tk时刻的量测量;r=[o 0 t]t为系统噪声驱动阵;Hk=[i 0 0]为量测阵,Vk为量测噪声序列。
[0077]W上表达式代表了一个随机线性定常系统的滤波问题,应用Kalman基本滤波方 程式,有:
[007引
Figure CN103365295BD00102
[00間其中,鳥护=1.2,...)为k时刻的状态估计,Q为非负定的系统噪声方差阵,Pk/k-1为 一步预测均方误差,Pk为估计均方误差,R=r,Hk=H,Kk为滤波增益,I为单位矩阵。
[0083] 根据滤波方程,只要给定初值-Ye和P。,根据Zk,就可W递推计算得到从而得到 经过滤波处理的声纳数据。式(3)和式(6)为滤波计算方程,式(4)和式(5)为增益计算方 程。其中增益计算方程是独立的,而滤波计算方程则依赖于增益计算方程。
[0084] 图4为滤波前和滤波后声纳数据的对比。从图形中可W看出,声纳数据在滤波前 有较多的数据噪声,最大的噪声误差值达到了 4m,误差百分率接近400%;经过滤波,噪声数 据基本被剔除,声纳数据波形光滑,滤波效果较好。
[00化]2.驱动器控制
[0086] 四旋翼无人飞行器驱动器的控制方法主要有开环控制和闭环控制两种方式。开环 控制的优点是控制简单、延时小、速度快,缺点是控制精度低;闭环控制的优点是控制精度 高,缺点是延时大、结构复杂,控制方法主要有PID控制、模糊控制、神经网络控制等等。
[0087] 根据本发明的控制要求,为简化控制电路设计,本发明选择开环控制作为驱动器 的控制方案。如图3所示,包括如下步骤:
[008引 1)系统初始化操作;
[0089] 当程序开始运行后,首先进行是系统初始化操作,初始化的内容包括:初始化系统 的控制寄存器、锁相环、看口狗W及时钟位默认状态;配置巧片的通用数字I/O为需要的功 能引脚;初始化外设中断向量表;使用特定的函数重新分配中断向量。然后是配置相应的 接口模块的寄存器。
[0090] 2)在系统完成初始化后,各接口开始与外部设备进行通信。其中,串口SCIB与机 载传感器MTi-G连接,波特率设置与MTi-G-致,为115200693,负责读取和验证^1-6发送 过来的姿态位置信息;串口SCIC与无线数传模块连接,波特率设置为192(K)bps,主要负责 通过无线数传模块的传输功能与地面站计算机进行数据通信,一方面将无人机部分的实时 状态信息发送至地面站计算机进行显示,另一方面可接收地面站计算机发送过来的航迹规 划指令和飞行算法参数调整指令;SPI接口与ARM模块进行通信,主要有两个功能,一个是 获得由ARM模块读取并经过滤波算法处理的声纳数据,另一个是将无人机全部的实时飞行 数据快速地发送至ARM模块,利用ARM模块扩展板上的SD卡进行保存,该种方式的优点是 数据传输速度快、保存的信息量大。
[0091] 3)控制算法程序安排在串口SCIB中断程序内。当读取完传感器MTi-G单元和声 纳传感器的数据之后,就进入控制算法程序。首先根据各个传感器的数据和飞行轨迹规划 指令,对程序中定义的实际飞行位置姿态变量和期望飞行位置姿态变量进行初始化。
[0092] 4)在完成各状态变量的初始化和坐标转换后,程序将进入飞行控制算法部分,使 用经典PID(比例-积分-微分)算法,结合之前读取到的数据,计算得到四个直流无刷电 机的转速值,该是直接控制输入量。然后,机载主控制器DSP的PWM模块将电机转速值解算 生成具有一定脉宽的PWM信号,输出至高速电子调速器,驱动电机转动产生相应的转速,使 得四旋翼无人飞行器完成自主悬停控制。
[0093] 在驱动器的开环控制中,输入量为PWM信号占空比,输出量为实际电机转速,PWM 信号占空比与电机转速的关系可用电机转速曲线来表示。由于电机转速曲线是非线性的, 本发明采用MTLAB的nlinfit函数来对转速曲线进行非线性拟合。nlinfit函数是基于最 小二乘法对模型的参数进行估计,采用牛顿迭代算法。拟合结果为
[0094]y= -58441x'+87159x-458741 (1)
[0095] 式中,X为PWM信号占空比,y为电机转速。该方法的最大转速拟合误差为13化pm, 基本满足系统要求。
[0096] 5) DSP的PWM模块将电机转速值解算生成具有一定脉宽的PWM信号,输出至高速 电子调速器,驱动电机转动产生相应的转速,使得四旋翼无人飞行器完成自主悬停控制。
[0097] 在整个控制系统中,机载传感器MTi-G的数据更新频率为lOOHz,它为内环姿态控 制器提供了角度、角速度等信息;串口SCIC与地面站数据通信频率为10化;声纳传感器的 数据更新频率为14化,为外环位置控制器提供了高度、Z轴线速度;GPS的数据更新频率为 4Hz,为外环位置控制器提供了位置和线速度。因此,内环姿态控制器的控制频率为lOOHz, 外环位置控制器的高度控制频率为14化,外环位置控制器的水平控制频率为4Hz。
[009引本发明基于搭建的硬件平台和设计的控制算法,进行了四旋翼无人飞行器自主悬 停控制实验,实验的内容包括姿态镇定W及高度控制,目的是要实现滚转角、俯仰角、偏航 角和高度共四个自由度的稳定控制。实验中,期望滚转角和期望俯仰角为0°,期望偏航角 为173°,期望高度为1.1m。
[0099] 实验过程中,四旋翼无人飞行器的高度(Z轴位移)、Z轴线速度、=维姿态角和= 维角速度如图5a至图化所示,数据采样周期为10ms,总飞行时间约为380s。
[0100] 图5a、图化、图5c为四旋翼无人飞行器的S维姿态角曲线,从图中可W看出,滚转 角和俯仰角的变化范围为-3°至2°,偏航角的变化范围为170°至176°。从图6a、图化、 图6c可W看出,无人飞行器的S维角速度变化较小,基本保持在±0. 4rad/s的范围内。通 过分析图5a、图化、图5c和图6a、图化、图6c可知,系统姿态控制器的控制效果较好,为高 度控制提供了稳定的飞行姿态。从图7a、图化中的高度曲线可W看出无人飞行器高度的变 化范围为Im至1.2m,高度控制的误差为0.Im,垂直方向上的线速度曲线变化范围为-0.3m/ S至0. 3m/s。从中分析可知,系统的高度控制基本保持稳定。
[0101] 实验结果表明,四旋翼无人飞行器较好地实现了自主悬停控制,搭建的硬件平台 结构较为合理,控制算法达到了预期的控制效果。

Claims (3)

1. 一种基于DSP的四旋翼无人飞行器自主悬停控制系统的控制方法,所述的基于DSP 的四旋翼无人飞行器自主悬停控制系统,包括有四旋翼机体(1)、分别设置在四个机翼上的 四个螺旋桨(2)以及控制四个螺旋桨(2)旋转的控制单元(3),其特征在于,所述的控制单 元(3)包括有:主控制单元(31)、地面计算机(32)、接收遥控器(33)信号的接收机(34)、 信号转换模块(35)、手动/自动切换芯片(36)以及用于驱动四个螺旋桨(2)上的直流无刷 电机工作的驱动单元(37),所述的主控制单元(31)通过无线网络连接地面计算机(32),所 述的接收机(34)与信号转换模块(35)和手动/自动切换芯片(36)依次连接,将接收到的 遥控器(33)所发出的信号通过信号转换模块(35)送入手动/自动切换芯片(36),用于控 制驱动单元(37)驱动四个螺旋桨(2)上的直流无刷电机工作,所述的接收机(34)还通过 主控制单元(31)连接手动/自动切换芯片(36),将接收到的信号通过主控制单元(31)送 入手动/自动切换芯片(36),用于控制驱动单元(37)驱动四个螺旋桨(2)上的直流无刷电 机工作;其特征在于,所述的控制方法包括:对声纳数据进行卡尔曼滤波处理获得准确的 高度数据和驱动器控制,其中,驱动器控制包括如下步骤: 1) 系统初始化操作; 2) 在系统完成初始化后,各接口开始与外部设备进行通信,其中,串口SCIB与机载传 感器MTi-G连接,读取和验证MTi-G发送过来的姿态位置信息;串口SCIC与无线数传模块 连接,通过无线数传模块的传输功能与地面站进行数据通信;SPI接口与ARM模块进行通 信,获得由ARM模块读取并经过滤波算法处理的声纳数据,并将无人机全部的实时飞行数 据快速地发送至ARM模块; 3) 根据各个传感器的数据和飞行轨迹规划指令,对程序中定义的实际飞行位置姿态变 量和期望飞行位置姿态变量进行初始化; 4) 进入飞行控制算法部分,使用经典PID算法,结合步骤2)读取到的数据,计算得到四 个直流无刷电机的转速值,直接控制输入量; 5. DSP的PWM模块将电机转速值解算生成具有一定脉宽的PWM信号,输出至高速电子调 速器,驱动电机转动产生相应的转速,使得四旋翼无人飞行器完成自主悬停控制。
2. 根据权利要求1所述的基于DSP的四旋翼无人飞行器自主悬停控制系统的控制方 法,其特征在于,所述的对声纳数据进行卡尔曼滤波是应用Kalman基本滤波方程式,有:
Figure CN103365295BC00021
其中,'斤=1,2,~):为k时刻的状态估计,Q为非负定的系统噪声方差阵,为一步 预测均方误差,Pk为估计均方误差,R=r,Hk=H,Kk为滤波增益,Zk为tk时刻的量测量,r =[0 0T]T为系统噪声驱动阵,
Figure CN103365295BC00031
:为时刻到tk时刻的一步转移阵,I为 单位矩阵。
3.根据权利要求1所述的基于DSP的四旋翼无人飞行器自主悬停控制系统的控制方 法,其特征在于,步骤4)所述的计算得到四个直流无刷电机的转速值,是采用MATLAB的 nlinfit函数来对转速曲线进行非线性拟合;nlinfit函数是基于最小二乘法对模型的参 数进行估计,采用牛顿迭代算法,拟合结果为 y = -58441x2+87159x-458741 式中,x为PWM信号占空比,y为电机转速。
CN201310272189.5A 2013-06-29 2013-06-29 基于dsp的四旋翼无人飞行器自主悬停控制系统及方法 Active CN103365295B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201310272189.5A CN103365295B (zh) 2013-06-29 2013-06-29 基于dsp的四旋翼无人飞行器自主悬停控制系统及方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201310272189.5A CN103365295B (zh) 2013-06-29 2013-06-29 基于dsp的四旋翼无人飞行器自主悬停控制系统及方法

Publications (2)

Publication Number Publication Date
CN103365295A CN103365295A (zh) 2013-10-23
CN103365295B true CN103365295B (zh) 2015-09-30

Family

ID=49366862

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201310272189.5A Active CN103365295B (zh) 2013-06-29 2013-06-29 基于dsp的四旋翼无人飞行器自主悬停控制系统及方法

Country Status (1)

Country Link
CN (1) CN103365295B (zh)

Families Citing this family (32)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN103792947A (zh) * 2014-02-28 2014-05-14 哈尔滨伟方智能科技开发有限责任公司 一种小型医疗救助旋翼飞行机器人
CN103885450B (zh) * 2014-03-03 2016-07-06 天津大学 无人直升机姿态非线性控制方法及验证平台
CN103853158A (zh) * 2014-03-17 2014-06-11 华北电力大学 一种多旋翼飞行机器人的高性能控制与计算系统
US9668146B2 (en) 2014-04-25 2017-05-30 The Hong Kong University Of Science And Technology Autonomous robot-assisted indoor wireless coverage characterization platform
CN103921949A (zh) * 2014-04-30 2014-07-16 哈尔滨工业大学 基于瑞萨芯片r5f100lea的四旋翼自主飞行器
CN103941750B (zh) * 2014-04-30 2016-08-31 东北大学 基于小型四旋翼无人机的构图装置及方法
CN104076817A (zh) * 2014-06-18 2014-10-01 北京计算机技术及应用研究所 一种高清视频航拍多模传感器自外感知智能导航系统及其方法
JP6486024B2 (ja) 2014-07-02 2019-03-20 三菱重工業株式会社 構造物の屋内監視システム及び方法
CN104808676B (zh) * 2015-03-09 2018-08-03 上海交通大学 基于外部视觉的四旋翼无人飞行器全自主飞行控制系统
CN104700683A (zh) * 2015-03-18 2015-06-10 刘建平 实景双向互动式驾驶平台
WO2016187759A1 (en) * 2015-05-23 2016-12-01 SZ DJI Technology Co., Ltd. Sensor fusion using inertial and image sensors
CN104932529B (zh) * 2015-06-05 2018-01-02 北京中科遥数信息技术有限公司 一种无人机自主飞行的云端控制系统
WO2017008246A1 (en) * 2015-07-14 2017-01-19 SZ DJI Technology Co., Ltd. Method, apparatus, and system for determining a movement of a mobile platform
CN105223575B (zh) * 2015-10-22 2016-10-26 广州极飞科技有限公司 无人机、无人机的测距滤波方法及基于该方法的测距方法
CN105292451A (zh) * 2015-10-28 2016-02-03 东莞市吉飞机器人有限公司 用于火灾现场勘测的防火无人机系统
CN105230444B (zh) * 2015-11-09 2018-01-23 武汉大学 一种全角度风力控制水枪装置
CN205120973U (zh) * 2015-11-14 2016-03-30 深圳市易特科信息技术有限公司 用于定位核辐射放射源的无人机系统
CN105323487A (zh) * 2015-11-20 2016-02-10 广州亿航智能技术有限公司 摄像设备指向方位控制装置
WO2018034033A1 (ja) * 2016-08-16 2018-02-22 本郷飛行機株式会社 通信制御装置
CN107416212A (zh) * 2016-09-07 2017-12-01 亿航智能设备(广州)有限公司 一种多旋翼飞行器的电机调速系统以及多旋翼飞行器
CN106292713A (zh) * 2016-10-28 2017-01-04 天津城建大学 一种多旋翼飞行器控制系统
CN107111320A (zh) * 2016-12-28 2017-08-29 深圳市大疆创新科技有限公司 无人机及其控制系统与控制方法、电调及其控制方法
WO2018161193A1 (zh) * 2017-03-05 2018-09-13 肖丽芳 一种四轴灯光飞行器
CN106814743A (zh) * 2017-03-13 2017-06-09 合肥谷飞智能科技有限公司 基于dsp的多旋翼无人机驱动控制系统
CN107389968B (zh) * 2017-07-04 2020-01-24 武汉视览科技有限公司 一种基于光流传感器和加速度传感器的无人机定点实现方法和装置
CN107505833B (zh) * 2017-08-01 2021-09-03 南京理工大学 一种基于嵌入式操作系统的飞行控制系统及方法
CN107562068B (zh) * 2017-09-28 2020-07-10 天津理工大学 一种四旋翼飞行器姿态的动态面输出调节控制方法
CN108107905A (zh) * 2017-12-20 2018-06-01 电子科技大学 一种景区航拍飞行系统及其控制方法
CN109159920B (zh) * 2018-09-21 2020-09-08 农业农村部南京农业机械化研究所 多旋翼无人飞机风场模拟试验台
CN110427046A (zh) * 2019-07-26 2019-11-08 沈阳航空航天大学 一种三维平滑随机游走无人机群移动模型
KR102320171B1 (ko) * 2019-12-30 2021-11-02 (주)위메이크드론 가상 드론 훈련 시뮬레이터를 위한 드론 조종기 바인딩 시스템 및 그 방법
CN111290424B (zh) * 2020-03-26 2020-11-06 南方医科大学南方医院 用于医院血液样本运输的无人机姿态控制方法及无人机

Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101192064A (zh) * 2006-11-24 2008-06-04 中国科学院沈阳自动化研究所 小型无人直升机自主飞行控制系统
KR100999556B1 (ko) * 2008-04-30 2010-12-08 부산대학교 산학협력단 무인 비행기 조종 시스템 및 그 방법
CN102955478A (zh) * 2012-10-24 2013-03-06 深圳一电科技有限公司 无人机飞行控制方法及系统

Family Cites Families (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2008033083A2 (en) * 2006-09-14 2008-03-20 Dst Control Ab Control system
US8543265B2 (en) * 2008-10-20 2013-09-24 Honeywell International Inc. Systems and methods for unmanned aerial vehicle navigation
US8733690B2 (en) * 2009-08-24 2014-05-27 Joby Aviation, Inc. Lightweight vertical take-off and landing aircraft and flight control paradigm using thrust differentials
CN102591350A (zh) * 2011-01-06 2012-07-18 佛山市安尔康姆航拍科技有限公司 四旋翼无人飞行器的飞行控制方法和系统
CN102582826B (zh) * 2011-01-06 2015-09-30 佛山市安尔康姆航拍科技有限公司 一种四旋翼无人飞行器的驾驶方法和系统
CN102117072B (zh) * 2011-03-10 2014-10-15 上海交通大学 具有旋翼转速检测功能的多旋翼飞行器地面测控系统
CN102424112B (zh) * 2011-11-30 2014-01-22 东北大学 微小型四旋翼飞行器的三层机载飞控装置
CN102955477B (zh) * 2012-10-26 2015-01-14 南京信息工程大学 一种四旋翼飞行器姿态控制系统及控制方法
CN102941920A (zh) * 2012-12-05 2013-02-27 南京理工大学 一种基于多旋翼飞行器的高压输电线路巡检机器人及其方法

Patent Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101192064A (zh) * 2006-11-24 2008-06-04 中国科学院沈阳自动化研究所 小型无人直升机自主飞行控制系统
KR100999556B1 (ko) * 2008-04-30 2010-12-08 부산대학교 산학협력단 무인 비행기 조종 시스템 및 그 방법
CN102955478A (zh) * 2012-10-24 2013-03-06 深圳一电科技有限公司 无人机飞行控制方法及系统

Also Published As

Publication number Publication date
CN103365295A (zh) 2013-10-23

Similar Documents

Publication Publication Date Title
CN103365295B (zh) 基于dsp的四旋翼无人飞行器自主悬停控制系统及方法
CN104656664B (zh) 车载多旋翼无人直升机着陆导引控制系统及导引控制方法
CN107589752B (zh) 无人机与地面机器人协同编队实现方法及系统
US20210191426A1 (en) Aircraft attitude control methods
CN104597912A (zh) 一种六旋翼无人直升机跟踪飞行控制系统及方法
CN104656660A (zh) 微小型无人直升机多模态自主飞行的控制系统及其方法
CN103611324A (zh) 一种无人直升机飞行控制系统及其控制方法
CN104460685A (zh) 一种四旋翼飞行器的控制系统及其控制方法
CN104875890A (zh) 四旋翼飞行器
KR101519954B1 (ko) 수직 이착륙 무인 항공기
CN104494820A (zh) 油动四旋翼无人飞行器
CN204314726U (zh) 一种六旋翼无人直升机跟踪飞行控制系统
CN105468010A (zh) 多自由度惯性传感器四轴无人机自主导航飞行控制器
CN205574270U (zh) 一种基于四旋翼飞行器的运载机械手
CN104166054A (zh) 基于多旋翼机器人的空中无线电监测系统
CN204719541U (zh) 无线视频监控及多pid调节控制姿态的四旋翼飞行器
Dantsker et al. Design, Development, and Initial Testing of a Computationally-Intensive, Long-Endurance Solar-Powered Unmanned Aircraft
CN105549609A (zh) 微型六轴飞行器及其构成的机群控制系统和控制方法
AU2019100363A4 (en) Unmanned Aerial Vehicle And Its Program Control Device Unmanned Aerial Vehicle And Its Program Control Device
Lin et al. Modelling and attitude control of novel multi-ducted-fan aerial vehicle in forward flight
Yan et al. IoT UAV control based on DIC-PID in water quality measurement application
Dantsker et al. Continued development and flight testing of a long-endurance solar-powered unmanned aircraft: Uiuc-tum solar flyer
CN206451046U (zh) 四旋翼飞行器
CN204808048U (zh) 一种数字化航拍控制系统
Du et al. Design and control of a mini quad-rotor UAV based on embedded system

Legal Events

Date Code Title Description
C06 Publication
PB01 Publication
C10 Entry into substantive examination
SE01 Entry into force of request for substantive examination
C14 Grant of patent or utility model
GR01 Patent grant