技术应用

小型无人机全姿态增稳控制系统的设计与实现

发布时间:2016-03-08 00:00:00 责任编辑:wenwei

【导读】在无人机中,飞控系统是主要组成部分,而姿态增稳控制则是对无人机顺利执行各项任务的有效方法。本文以实际应用为背景,详细介绍了基于三轴陀螺和倾角传感器构成全姿态增稳控制系统的硬件实现及软件设计,并将其运用在某型无人机中,针对系统中飞行姿态控制的的流程和内环姿态控制的规律进行了详细的分析与研究。
  
在无人机中,飞控系统是主要组成部分,而姿态增稳控制则是对无人机顺利执行各项任务的有效方法。本文以实际应用为背景,详细介绍了基于三轴陀螺和倾角传感器构成全姿态增稳控制系统的硬件实现及软件设计,并将其运用在某型无人机中,针对系统中飞行姿态控制的的流程和内环姿态控制的规律进行了详细的分析与研究。经过百余次试飞,基于三轴陀螺和倾角传感器构成的姿态增稳控制系统,不仅满足了现阶段任务要求,还达到了良好的效果,为同类无人机的开发与研制提供了一套行之有效的方法。
 
系统特点
 
由陀螺和倾角传感器构成全姿态增稳控制回路。陀螺测量得到的角速度信息用作增稳反馈控制,使飞机操纵起来变的更“迟钝”一些,从而利用倾角传感器测得飞机横滚角和俯仰角。然后将陀螺测得的角速率信息和倾角传感器测得的姿态角进行捷联运算,得到融合后的姿态信息。这种较为复杂的捷联算法可使姿态精度得到很大提高。
 
姿态增稳控制律硬件设计
 
无人机姿态增稳控制属于内回路控制,它包括姿态保持与控制、速度控制等模式。内回路控制是在以三轴陀螺和倾角传感器获取无人机飞行姿态的基础上,通过对升降舵、方向舵的控制,完成飞行姿态的稳定与控制。内回路控制作为飞行控制的核心回路,也是飞行高度、航迹等外回路控制的基础。外回路控制是以GPS的位置、航向信号、高度传感器的气压高度信号为基准的,它通过导航控制方法计算出飞行器的预定航线和实际航线。
 
无人机内回路控制作为外回路控制的基础,对其能否稳定飞行起着至关重要的作用。该系统中,内回路是由三轴陀螺和倾角传感器构成的姿态增稳控制回路。主要由主控制单片机、A/D采样芯片、三轴陀螺仪和倾角传感器组成。主控制单片机通过SPI串行总线与A/D采样芯片相连,通过A/D采样芯片获得三轴陀螺仪的角速率与倾角传感器的横滚角和俯仰角,然后进行姿态信息融合,得到无人机俯仰和横滚的姿态信息。主要接口连接情况如图1所示。
 
小型无人机全姿态增稳控制系统的设计与实现
 
图l中,AD7888是一款高速率、低功耗的12位模拟数字转换器,能达到125 KSPS的传输速率,拥有8路模拟输入通道。为片选引脚,该引脚有两个作用,即启动AD7888转换器和制定串行数据的转移,与单片机引脚PB0()相连。SCLK为串行时钟输入引脚,通过外接单片机ATmegal28引脚 PBl(SCK)提供串行时钟信号。DIN为逻辑数据输入端,DOUT为逻辑数据输出端,分别与ATmegal28的引脚PB2(MOSI)和 PB3(MISO)相连。
 
外部基准电压的范围是Vref~VDD(Vref=1.2 V)。为了获得稳定的基准电压,采用由TL431组成基准电压电路。德州仪器公司(TI)生产的TL431是一个有良好热稳定性能的三端可调分流基准源。它的输出电压用电阻R2和R3就可以设置到从Vref=2.5 V到Vref=36 V范围内的任何值。
 
单片机ATmegal28与AD7888通过串行通信接口SPI相连,分别配置为主机和从机。SPI总线允许ATmegal28与外设之间进行高速的同步数据传输。
 
三轴陀螺主要用来测量无人机在飞行过程中俯仰角、横滚角和偏航角的角速度,并根据角速度积分计算角度的改变。该系统中采用日本松下公司的EWTS82(以下简称S82),其原理是将旋转时音叉震荡产生的地球偏转力(克里奥利力)转换为电信号。该三轴陀螺由传感器件、音叉驱动电路和信号处理电路构成。此款陀螺为一模拟器件,具有+80~-80(°)/s的测量范围,单电源(+5 V DC)供电,对零点漂移抑制较好等优点。另外,其低廉的价格可大大降低开发成本。
 
倾角传感器采用芬兰VTI Technologies公司生产的高精度双轴倾角传感器SCAl00T,该传感器的体积小,重量轻。其内部包含了一个硅敏感电容传感器和一个ASIC专用集成电路,既具有内部温度测量及补偿功能,又具备自检测功能,单轴最大输出范围约为-40~+40 ℃,有效输出范围为-30~+30 ℃。当采样频率为8 Hz及以下时,可获得0.002°的输出分辨率。串行外围接口SPI的输出频率为500 kHz,通过传感器元件控制频率响应,能够承受大于20 000g的机械振动。它具有的主要特点是:x,y双轴高分辨率双向测量,单电源(+5 V DC)供电,工作电流小(3 mA),噪声低,工作温度范围宽(-40~+125 ℃)等。
  
姿态增稳控制软件设计
 
整个飞控系统的输入量即为传感器所采集的飞行状态值,输出量为飞机状态方程的控制变量(舵值和发动机推力),所以飞控系统实质上是一个多通道的控制系统,即多输入/多输出控制系统。其中,飞控系统的核心控制回路是以姿态角(俯仰角/滚转角的)反馈信号为基础构成的飞行姿态稳定和控制回路,即内回路。
 
在内回路的基础上,又引入高度保持、航迹控制等外回路。
 
在飞控系统的姿态增稳控制回路中三轴陀螺实时反馈飞机的俯仰、横滚和偏航的角速率。另外,将三轴陀螺的俯仰角速率和横滚角速率分别与倾角传感器测得的俯仰角和横滚角进行姿态捷联解算。主控单片机利用定时/计数器O的定时中断,间隔30 ms循环进行内环的姿态控制,控制流程如图2所示。由于飞机沿纵向平面的对称性,无人机飞行控制可以分为相对独立的纵向控制和横侧向控制通道。
 
小型无人机全姿态增稳控制系统的设计与实现
 
(1)横侧向控制通道:无人机的横侧向运动即无人机的滚转和偏航运动,主要通过副翼通道来实现。在横侧向控制通道中有滚转角反馈和滚转角速率反馈,这两项构成了滚转通道的核心回路——内回路。另外,航向偏差反馈只有在无人机作定向直飞、航向跟踪或者自主导航时才需要接人,以稳定控制无人机的飞行航向;侧偏距反馈仅当无人机进入自主导航时才需要接入,以控制无人机跟踪预先设置的飞行航线;误差积分反馈仅仅当无人机做定向直飞时才接入,以消除无人机左右不对称性等因素的影响,改善无人机航向控制的精度以及左右转弯的对称性。
 
(2)纵向控制通道:无人机的纵向运动即指无人机的俯仰及升降运动。无人机的纵向运动规律是通过操纵无人机的升降舵来实现的。在纵向控制通道中有俯仰角反馈和俯仰角速率反馈,这两项构成了纵向通道的核心控制回路——内回路。另外,还有高度差反馈,只有在无人机做定高飞行时才需要接入,以稳定无人机的飞行高度。纵向控制俯仰角通道的框图如图3所示。
 
小型无人机全姿态增稳控制系统的设计与实现
 
通常可以把无人机飞行过程划分为几个相对独立的航段。一个最基本的自主飞行工程可以划分为6个航段:起飞阶段、出航平飞阶段、转弯阶段、返航平飞阶段、盘旋阶段和着陆阶段。每个航段的任务相对独立,把各航段的复杂飞行状态分解为几个基本的飞行任务:平飞、转弯、升降等。这样通过相对独立的纵向控制通道和横侧向控制通道来协调实现无人机的平飞、转弯、升降等基本飞行任务。



推荐阅读:






 
要采购传感器么,点这里了解一下价格!

为您推荐

纳芯微推出 NSPAD3N,国产车规绝压传感器用于电池热失控监测 新品速递

纳芯微推出 NSPAD3N,国产车规绝压传感器用于电池热失控监测

纳芯微发布车规级 MEMS 绝压传感器 NSPAD3N,全链路国产供应链,满足 AEC-Q100;芯片内置两套热失控判定算法,支持主控休眠状态下低功耗监测、异常唤醒,85℃下采样电流<35μA;量程 40–400kPa 可定制、16 位 SPI 输出,搭载 256 字节 FIFO 记录压力历史,DFN-8 小型封装,特殊进气结构保护敏感芯体,适配新能源电池包 BMS 压力监测。

汽车电子 能源电路 互联技术 传感技术 传感器

人形机器人的 “神经系统”:多模态感知 + 确定性连接,构建时序统一的环境认知 技术应用

人形机器人的 “神经系统”:多模态感知 + 确定性连接,构建时序统一的环境认知

多模态感知是人形机器人适配真实人机环境的基础,而高性能确定性连接是感知融合的核心前提。视觉、触觉、力传感、IMU 等传感器持续产生海量数据,依靠分布式通信骨干网完成时序同步,避免延迟、抖动带来的失控与安全风险。当多模态感知与可靠通信结合,机器人才能形成连贯的环境认知,支撑稳定行走、安全交互与智能规划。

通信广电 传感技术 传感器

英特尔联合 Altera 开发实时传感器桥接方案,面向医疗、机器人等物理 AI 与边缘计算场景 业界新闻

英特尔联合 Altera 开发实时传感器桥接方案,面向医疗、机器人等物理 AI 与边缘计算场景

今日,英特尔与 Altera 宣布合作开发灵活的实时传感器桥接模块化参考方案,面向医疗健康、机器人等边缘计算与物理 AI 应用。当前边缘设备传感器数量持续增长,多接口、多源数据带来时序同步、带宽、实时性等集成难题。方案融合英特尔计算、连接与软件栈优势和 Altera FPGA 可编程能力,可灵活适配不同传感器配置与负载,支持 I/O 外扩、确定性实时处理,配套英特尔开放边缘平台 SDK 与 Altera 开发工具,帮助 OEM 厂商简化系统集成,缩短原型到量产周期,兼顾性能、功耗与成本,重点满足医疗器械、智能机器人的低延迟感知与控制需求。

医疗穿戴 电源管理 传感技术 传感器

Melexis MLX90636 全新上市:超小 CSP 封装 FIR 传感器,打通腕温到核心体温推算路径 新品速递

Melexis MLX90636 全新上市:超小 CSP 封装 FIR 传感器,打通腕温到核心体温推算路径

2026 年 11 月 11 日,迈来芯(Melexis)推出新一代非接触式远红外测温芯片 MLX90636。该器件采用 1.8×1.8×0.75mm 晶圆级 CSP 封装,在人体测温区间达到 ±0.2℃医疗级精度,可抵御环境温变与气流干扰,低功耗特性适配智能手表、手环、智能戒指等紧凑穿戴产品。在 MLX90632 基础上迭代升级,迈来芯同步启动腕温 - 核心体温推算算法研究,配套评估套件即将推出,为数字健康厂商提供从硬件到算法验证的完整支撑,芯片现已正式上市。

医疗穿戴 电源管理 传感技术 传感器 Melexis(比利时迈来芯)

Nordic 进军免许可 Sub‑GHz 通信:集成低功耗、安全与端侧 AI,适配水表资产追踪 业界新闻

Nordic 进军免许可 Sub‑GHz 通信:集成低功耗、安全与端侧 AI,适配水表资产追踪

低功耗无线物联网厂商 Nordic Semiconductor 正式进军免许可远距离 Sub‑GHz 赛道,推出集成超低功耗、安全机制与端侧 AI 的通信方案。Sub‑GHz 信号穿墙、地下表井通信能力突出,免许可频段无需运营商网络,水表、资产追踪器、楼宇传感器依靠单节电池即可长年工作。该方案归入 Nordic 芯片到云端平台,沿用原有 SDK、开发工具与云服务,以开放标准为主同时兼容存量私有协议,丰富其多协议无线产品矩阵。

通信广电 能源电路 传感技术 EMC安规 传感器 NORDIC

特别推荐

更多

行业动态

更多

技术应用

更多

选型替代

更多

产品信息

更多

热门搜索

更多

欢迎登录

没有账号,

账号注册

注册成功!

3S后自动为你跳转登陆