基于STM32单片机的无人机飞行控制系统设计优秀毕业论文 参考文献 可复制黏贴.pdf_第1页
基于STM32单片机的无人机飞行控制系统设计优秀毕业论文 参考文献 可复制黏贴.pdf_第2页
基于STM32单片机的无人机飞行控制系统设计优秀毕业论文 参考文献 可复制黏贴.pdf_第3页
基于STM32单片机的无人机飞行控制系统设计优秀毕业论文 参考文献 可复制黏贴.pdf_第4页
基于STM32单片机的无人机飞行控制系统设计优秀毕业论文 参考文献 可复制黏贴.pdf_第5页
已阅读5页,还剩71页未读, 继续免费阅读

基于STM32单片机的无人机飞行控制系统设计优秀毕业论文 参考文献 可复制黏贴.pdf.pdf 免费下载

版权说明:本文档由用户提供并上传,收益归属内容提供方,若内容存在侵权,请进行举报或认领

文档简介

中图分类号 tp391 论文编号 1028701 12 s177 学科分类号 082501 硕士学位论文 基于 stm32 单片机的无人机飞行控制 系统设计 研究生姓名 胡 庆 学科 专业 飞行器设计 研 究 方 向 无 人 机飞行控制 指 导 教 师 宋彦国 副教授 南京航空航天大学 研究生院 航空宇航学院 二 一二年三月 nanjing university of aeronautics and astronautics the graduate school college of aerospace engineering the design of uav flight control system based on stm32 micro control unit a thesis in flight vehicle design by huqing advised by professor song yanguo submitted in partial fulfillment of the requirements for the degree of master of engineering march 2012 承诺书 本人郑重声明 所呈交的学位论文 是本人在导师指导下 独立进 行研究工作所取得的成果 尽我所知 除文中已经注明引用的内容外 本学位论文的研究成果不包含任何他人享有着作权的内容 对本论文所 涉及的研究工作做出贡献的其他个人和集体 均已在文中以明确方式标 明 本人授权南京航空航天大学可以有权保留送交论文的复印件 允许 论文被查阅和借阅 可以将学位论文的全部或部分内容编入有关数据库 进行检索 可以采用影印 缩印或其他复制手段保存论文 保密的学位论文在解密后适用本承诺书 作者签名 日 期 南京航空航天大学硕士学位论文 i 摘 要 本文从工程应用出发 将航模固定翼飞机作为研究平台 在总结国内外微小型无人机飞行 控制系统设计的基础上 提出了低成本飞行控制系统设计方案 首先 提出飞行控制系统总体方案 对硬件系统进行了详细设计 无人机硬件系统总体分 为两个部分 机载飞控系统和地面测控系统 其中机载飞控系统以 stm32 微控制器为核心 集 成了数据采集系统 gps 模块 遥控解码模块 舵机驱动模块 数传电台和电源模块 地面测 控系统包括测控计算机 数传电台 地面站软件 发射机等 其次 对无人机捷联导航算法进行了研究 捷联导航算法用于无人机姿态 速度 位置等 信息的滤波解算 是解决无人机飞行状态准确测量的关键技术之一 本文设计了基于误差四元 数的姿态卡尔曼滤波算法 同时考虑在大机动情况下 刚体加速度的影响 采用组合滤波的方 法 提高姿态解算的精度 并进行了仿真验证 通过引入 gps 的速度和位置量测信息 分别设 计了速度 位置卡尔曼滤波器 然后 建立了无人机的飞行动力学模型 基于该模型采用 pid 控制方法对无人机纵向 横 侧向控制回路控制律进行设计 同时对无人机的自主飞行进行研究 给出了直线自主飞行和圆 周自主飞行制导参数的计算方法 并设计了相应的控制律 之后进行了仿真 验证了所设计的 控制律 最后 展开无人机的试验研究 验证了飞行控制系统硬件与捷联导航算法的可靠性和可行 性 关键字 无人机 捷联导航 四元数 卡尔曼滤波器 飞行控制 基于 stm32 单片机的无人机飞行控制系统设计 ii abstract the remote control fixed wing plane is chosen as the research platform and the low cost flight control system is designed based on the existing uav system firstly the scheme of flight control system is conducted and the detail hardware is developed the uav hardware system include flight control system and ground control station the flight control system is made up of stm32 mcu sensors gps module remote control signal decode module servo control module rf module and power supply module the ground control station is made up of computer rf module ground control station software and command box secondly strapdown navigation algorithm is researched it s the key technology to an uav system the error quaternion based attitude kalman filter is developed in this paper considering influence of rigid acceleration the combined filter is designed to improve the precision of estimation the simulation test shows good performance of this navigation algorithm the velocity and position kalman filter is designed by using of gps signal thirdly the classical pid control method is used to design control law and the simulation test is carried out furthermore the autonomous flight control law is researched and calculation of navigation parameter is designed in both straight line flight path and curve line flight path states finally the experiment is carried out to prove the practicability and reliability of the flight control system and navigation algorithm keywords uav strapdown navigation quaternion kalman filter flight control 南京航空航天大学硕士学位论文 iii 目 录 第一章 绪论 1 1 1 课题研究背景及意义 1 1 2 国内外研究现状 1 1 2 1 无人机研究 1 1 2 2 飞行控制系统 3 1 3 本文研究内容及方法 5 第二章 飞行控制系统方案设计 7 2 1 引言 7 2 2 飞行控制系统设计要求 7 2 3 飞行控制系统试验平台 8 2 4 飞行控制系统总体方案设计 8 2 4 1 机载飞控系统 9 2 4 2 地面测控系统 10 2 5 飞行控制系统硬件方案 11 2 5 1 嵌入式飞控计算机 11 2 5 2 传感器数据采集 12 2 5 3 gps 模块 15 2 5 4 遥控解码模块 16 2 5 5 舵机驱动子系统 16 2 5 6 数传电台 17 2 5 7 电源模块 17 2 6 飞行控制系统软件设计 17 2 6 1 飞行控制系统软件设计需求 17 2 6 2 飞行控制系统软件流程 18 第三章 基于单片机的捷联导航算法研究 20 3 1 引言 20 3 2 坐标系定义及变换 20 3 3 捷联姿态矩阵更新算法 21 3 3 1 四元数法 22 基于 stm32 单片机的无人机飞行控制系统设计 iv 3 3 2 四元数微分方程的龙格 库塔法求解 23 3 3 3 四元数微分方程的等效旋转矢量法求解 23 3 4 导航滤波算法 25 3 4 1 姿态估计算法 25 3 4 2 速度估计算法 30 3 4 3 位置估计算法 31 第四章 无人机控制律设计 33 4 1 引言 33 4 2 无人机数学模型 33 4 3 pid 控制方法 34 4 4 纵向控制律设计 35 4 4 1 俯仰角保持 控制回路 35 4 4 2 高度保持 控制回路 36 4 5 横侧向控制律设计 38 4 5 1 横滚角保持 控制回路 38 4 5 2 偏航角保持 控制回路 39 4 6 协调转弯控制 40 4 7 自主飞行控制律设计 43 4 7 1 直线自主飞行控制律设计 43 4 7 2 圆周自主飞行控制律设计 45 4 7 3 数值仿真 47 第五章 试验验证 49 5 1 引言 49 5 2 试验系统组成 49 5 3 试验内容及结果 49 第六章 总结与展望 52 6 1 本文主要贡献和特点 52 6 2 进一步的工作和展望 52 参考文献 54 致谢 57 在学期间的研究成果及发表的学术论文 58 南京航空航天大学硕士学位论文 v 图标清单 图 1 1 云雀 无人机 2 图 1 2 渡鸦 无人机 2 图 1 3 扫描鹰 无人机 2 图 1 4 asn 206 无人机 3 图 1 5 ap50 飞行控制系统 4 图 1 6 mp2028 飞行控制系统 4 图 1 7 ifly40 飞行控制系统 5 图 2 1 金星 40 级油动固定翼 8 图 2 2 飞行控制系统总体结构图 9 图 2 3 机载飞控系统实物图 9 图 2 4 主控电路板原理图 10 图 2 5 地面站软件人机界面 11 图 2 6 传感器数据采集系统硬件结构图 13 图 2 7 角速率陀螺信号调理电路 14 图 2 8 adxl202 加速度计功能结构图 14 图 2 9 磁强计模块 15 图 2 10 gps 模块 15 图 2 11 gps 模块电路原理图 16 图 2 12 遥控解码模块 16 图 2 13 主程序流程图 18 图 2 14 20ms 定时器中断程序流程图 19 图 3 1 机体坐标系与导航坐标系的关系 20 图 3 2 姿态估计原理图 25 图 3 3 姿态估计仿真结构图 28 图 3 4 无刚体加速度时横滚角仿真图 29 图 3 5 无刚体加速度时俯仰角仿真图 29 图 3 6 无刚体加速度时加速度模值 29 图 3 7 有刚体加速度时横滚角仿真图 29 图 3 8 有刚体加速度时俯仰角仿真图 29 基于 stm32 单片机的无人机飞行控制系统设计 vi 图 3 9 有刚体加速度时加速度模值 30 图 4 1 俯仰角保持 控制结构图 35 图 4 2 俯仰角响应 36 图 4 3 高度保持 控制结构图 37 图 4 4 高度响应 37 图 4 5 滚转角保持 控制结构图 38 图 4 6 横滚角响应 39 图 4 7 偏航角保持 控制结构图 39 图 4 8 偏航角响应 40 图 4 9 无人机转弯受力图 40 图 4 10 协调转弯控制结构图 42 图 4 11 协调转弯偏航角响应 42 图 4 12 协调转弯横滚角响应 42 图 4 13 协调转弯高度响应 42 图 4 14 协调转弯侧偏速度响应 42 图 4 15 样例航迹任务图 43 图 4 16 直线自主飞行原理图 44 图 4 17 直线自主飞行控制结构图 45 图 4 18 圆周自主飞行原理图 46 图 4 19 圆周自主飞行控制结构图 47 图 4 20 自主飞行水平位置 48 图 4 21 自主飞行高度 48 图 5 1 飞行试验系统 49 图 5 2 推车试验姿态数据 50 图 5 3 推车试验加速度数据 50 图 5 4 速度滤波数据效果图 51 图 5 5 位置滤波数据效果图 51 表 2 1 角速率传感器性能指标 13 表 2 2 加速度计传感器性能指标 14 表 2 3 磁强测量模块性能指标 15 表 2 4 数传电台性能指标 17 南京航空航天大学硕士学位论文 vii 表 3 1 等效旋转矢量微分方程求解方法 24 表 4 1 俯仰角保持 控制回路参数表 36 表 4 2 高度保持 控制回路参数表 37 表 4 3 横滚角保持 控制回路参数表 38 表 4 4 偏航角保持 控制回路参数表 40 表 4 5 航点数据 47 基于 stm32 单片机的无人机飞行控制系统设计 viii 注释表 滚转角 俯仰角 偏航角 b nc 姿态矩阵 q 转动四元数 等效旋转矢量 角增量 hq 变换四元数 iq 姿态四元数 加速度计模的阀值 sq 姿态四元数 ieq 误差四元数 ba 真实体轴系加速度矢量 真实角速率 b 陀螺输出的角速率 g 陀螺仪漂移误差 gw 一阶马尔科夫过程 tx 滤波方程状态变量 ta 状态矩阵 tb 控制矩阵 tz 观测值 th 量测矩阵 1 kk 状态转移矩阵 1 kkb 控制输入矩阵 1 ku 输入矢量 1 kk 噪声驱动矩阵 1 kw 过程噪声矢量 kz 观测向量 kh 量测矩阵 南京航空航天大学硕士学位论文 ix kv 量测噪声矢量 kq 过程噪声的对称非负定方差矩阵 kr 量测噪声的对称正定方差矩阵 kx 状态变量 kx 预测状态变量 kk 滤波增益 1 kkp 预测误差协方差 kp 误差协方差 0x 初始状态变量 0p 初始误差协方差 u 体轴系纵向速度 v 体轴系侧向速度 w 体轴系垂向速度 a 速度滤波器状态矩阵 vu 速度滤波器输入矩阵 l 纬度 经度 0l 初始纬度 0 初始经度 h 海拔高度 np 导航系位置矢量 nv 导航系速度矢量 kr 期望值 ky 实际输出值 ke 偏差 ku 控制输入量 sg 传递函数 pk 比例系数 it 积分时间常数 dt 微分时间常数 e 纵向周期变距 a 横向周期变距 基于 stm32 单片机的无人机飞行控制系统设计 x c 总距 r 尾距 k 俯仰姿态控制回路比例系数 ik 俯仰姿态控制回路积分系数 k 横滚角控制回路比例系数 ik 横滚角控制回路积分系数 k 偏航角控制回路比例系数 ik 偏航角控制回路积分系数 qk 俯仰角速率阻尼系数 pk 横滚角速率阻尼系数 rk 偏航角速率阻尼系数 uk 纵向速度控制回路比例系数 iuk 纵向速度控制回路积分系数 vk 侧向速度控制回路比例系数 ivk 侧向速度控制回路积分系数 hk 高度控制回路比例系数 ihk 高度控制回路积分系数 ak 垂向阻尼系数 xk 纵向位置控制回路比例系数 ixk 纵向位置控制回路积分系数 yk 侧向位置控制回路比例系数 iyk 侧向位置控制回路积分系数 d 侧偏距 l 航点间距 v 地速与北向夹角 s 待飞距离 e 航向偏差角 南京航空航天大学硕士学位论文 1 第一章 绪论 1 1 课题研究背景及意义 无人机是一种由动力驱动 无人驾驶 可重复使用的航空器的简称 1 在军事上 因为具 有零伤亡 战场生存能力强等特点 非常适合执行高危险或人类无法参与的任务 在民用上 它也完全可以代替有人机完成一些任务 如救援搜索 灾情监测 气象探测等 微小型无人机 具有隐蔽性强 机动灵活 制造成本低等特点 但由于微小型无人机本身有限的负载能力和体积 限制 现有的一些导航和飞行控制系统很难直接在微小型无人机上使用 所以对微小型无人机 的嵌入式飞行控制系统进行研究工程意义重大 随着微机械传感技术 全球卫星导航技术 自动控制技术 通信技术的不断发展 无人机 已经逐渐进入实用阶段 在军事上无人机已经从单纯的空中侦察到现在的空中监控 导弹攻击 火力制导 通信中继 边界巡逻 甚至战斗任务中都发挥了重要的作用 取得了良好的军事效 益 各个国家都给予了相当程度的关注 在民用和警用领域 无人机同样发挥着重要的作用 无人机在航空摄影 地理测绘 遥测 遥感 大气监测 环境保护 资源勘探 通信中继 电力巡线 农药喷洒等领域也完全可以替 代有人机 具有光明的应用前景 目前 无人机飞行控制系统仍属于国际前沿技术 因为其军事运用价值显著 有必要自主 创新 研制具有自主知识产权的无人机飞行控制系统 1 2 国内外研究现状 1 2 1 无人机研究 下面针对本文的研究对象 对国内外几种无人机进行介绍 1 云雀 无人机 以色列拉菲尔武器发展局的 云雀 无人机是一种用于单兵便携型 空中巡逻和监视的系 统 如图 1 1 所示 其重量6公斤 螺旋桨直径为12厘米 在被一台助推器或小型火箭发动机 发射后 可瞬间展开为飞行模式 并由一部电动机提供动力 该无人机装备一部照相机提供宽 范围覆盖和兴趣点监视 其操作距离达到10公里 同时能在目标上空徘徊超过60分钟 提供实 时目标图像 在战斗区域直接支援 云雀无人机具有实时高分辨率成像 单兵操作 在狭小区 域发射等特点 基于 stm32 单片机的无人机飞行控制系统设计 2 图 1 1 云雀 无人机 2 渡鸦 无人机 渡鸦 是一种可装备彩色摄像机 红外摄像机 可执行夜间任务 具有轻便耐用 坠落 回收 易维修等特点的无人机 如图 1 2 所示 其机长3英尺 重量4 2磅 该无人机不仅能够 为部队回传图像提供有效的态势信息 还可以作为通信中继 图 1 2 渡鸦 无人机 3 扫描鹰 无人机 扫描鹰 是由英国因斯特公司和波音公司共同研制的一种弹射起飞 空中阻拦钩回收的 无人机 其机身长1 22米 翼展3 05米 全重15千克 最大飞行速度70节 最大飞行高度4900 米 同时 该无人机可以折叠贮藏 提高战术部署能力 图 1 3 扫描鹰 无人机 南京航空航天大学硕士学位论文 3 4 asn 206无人机 asn 206无人机是asn公司出产的一种轻型 近距 战术无人侦察机 如图 1 4 所示 该无 人机可用于昼夜空中侦察 战场侦察 目标定位 炮火定位 边境巡逻 核辐射取样 空中摄 影和探矿 以及电子战等 其具体性能指标为 翼展6米 机长3 8米 高度1 4米 最大起飞重 量222公斤 最大载荷50公斤 最大时速210公里 航程150公里 飞行高度5000 6000米 整套 无人机系统包括6至10辆运输发射车辆和一个地面控制站 图 1 4 asn 206 无人机 此外 国内很多高校和研究机构 如南京航空航天大学 北京航空航天大学和西北工业大 学成都飞机设计研究所等都进行了无人机系统的研究 前后研制了 长空一号 靶机 无侦 5 无人侦察机等 然而 我国仍缺少成熟的微小型无人机 因此有必要对适用于微小型无人机的 飞行控制系统进行研究 1 2 2 飞行控制系统 飞行控制系统是无人机最核心的部分 是无人机实现自主飞行的关键 下面对国内外几种 无人机的飞行控制系统进行介绍 1 ap50 ap50是美国uav flight systems公司开发的一款无人机飞行控制系统 如图 1 5 所示 它 具有飞行增稳控制和导航任务控制两个主要的功能 该飞控系统集成了三个微处理器 三轴陀 螺 两轴加速度计 空速管 气压计和主备电源监视器 ap50支持副翼 升降舵 油门 方向 舵和襟翼五个操纵舵面 可实现9个通道的pid控制器调整 通过地面站的任务编辑功能 可实 现无人机环绕目标或航线循环飞行 基于 stm32 单片机的无人机飞行控制系统设计 4 图 1 5 ap50 飞行控制系统 2 mp2028 mp2028是加拿大micropilot出产的世界上最小的自动驾驶仪 如图 1 6 所示 其尺寸仅有 12cm 6 4cm 重量为212g 包含电台在内的功耗不大于5瓦 具有体积小 调试方便 支 持自主起降 适用于小型无人机测绘任务等特点 图 1 6 mp2028 飞行控制系统 3 ifly40飞控 ifly40飞控是由北京航空航天大学自行研制的具有自主知识产权的新一代无人机自动驾 驶仪 其内部集成了三轴mems陀螺仪 三轴mems加速度计 微型气压高度计 微型空速传 感器 微型磁通门 微型gps接收机等 功能齐全 性能与国外同类产品相当 同时ifly40飞 控通过捷联导航算法实时解算姿态 能够实现精确的姿态控制 此外 该飞控还可以实现软硬 件的定制 以适用于不同的平台 这是国内外同类型产品所不具有的功能 南京航空航天大学硕士学位论文 5 图 1 7 ifly40 飞行控制系统 4 ys09飞控 ys09是由北京零度智能科技公司出产的一款无人机飞控系统 如图 1 8 所示 具有姿态稳 定 放手即飞 自动定高 自动返航等功能 并能够实现3米以内的导航精度 其低成本 高可 靠性的特点非常适用于航怕 测绘等任务 ys09飞控采用atmel公司的具有200m主频的 at91rm9200微控制器作为飞控计算机 外扩了sdram和flash 使用3轴加速度计与3轴陀螺仪集 成器件adis16355作为惯性测量单元 同时集成了两片ms5534a气压传感器及ublox的lea 4s芯 片 图1 8 ys09飞行控制系统 1 3 本文研究内容及方法 本文针对微小型无人机的飞行控制系统进行了设计和研制工作 以航模固定翼飞机为试验 平台 完成了嵌入式飞行控制系统的硬件设计 调试 在此基础上设计了捷联导航算法 重点 针对无人机的特点进行了飞行控制律的设计 最后 展开了地面试车及推车试验 本论文一共分为六章 各部分主要内容如下 第一章 介绍了论文选题的背景与意义 叙述了国内外现有的一些无人机系统 详细介绍 基于 stm32 单片机的无人机飞行控制系统设计 6 了一些商用无人机飞行控制系统的功能及特点 最后引出了本文各章的研究内容及方法 第二章 详细介绍了无人机飞行控制系统的硬件设计研制工作 它包括机载飞控系统和地 面测控系统两部分 其中机载飞控系统以 stm32 微控制器为核心 包括数据采集系统 gps 模 块 遥控解码模块 舵机驱动模块 数传电台模块 电源模块等 地面测控系统包括测控计算 机 数传电台模块 地面站软件 发射机 稳定可靠的硬件系统是飞控系统研制成功与否的关 键 第三章 精确的姿态 速度 位置等导航信息 是无人机实现自主飞行的基础 本章以三 轴微机械陀螺仪 三轴加速度计 三轴磁强计及 gps 为基础 对捷联导航算法进行了研究 由 于陀螺具有常值漂移 温度漂移等误差特性 使得它只具有短时间的精确姿态测量能力 但在 动态环境下性能较好 同时加速度计 磁强计等误差漂移特性较小 但在动态环境下性能较差 本章通过采用多传感器信息融合算法将重力场矢量 磁场矢量与陀螺数据进行融合 同时还引 入了 gps 的速度 位置信息 得到长时间稳定 精确的导航信息 第四章 主要描述了基于无人机数学模型的飞行控制律设计 本章运用 pid 控制方法对无 人机纵向 横侧向回路及协调转弯控制律进行了设计 同时进行了仿真 然后详细论述了自主 飞行中 直线自主飞行和圆周自主飞行的制导参数计算方法 设计了相应的控制律 并进行了 样例航迹任务仿真 第五章 主要展开无人机的试验研究 验证了飞行控制系统与捷联导航算法的可靠性和实 用性 第六章 主要对本课题的研究工作进行了总结 阐述了课题工作中的成绩和不足 并对今 后的工作进行了展望 南京航空航天大学硕士学位论文 7 第二章 飞行控制系统方案设计 2 1 引言 为了达到自主飞行的目的 无人机飞行控制系统的设计是关键 本文从工程实践出发 介 绍了无人机飞行控制系统的计要求 并阐述了总体方案设计 重点对方案中的各个模块进行了 详细说明 2 2 飞行控制系统设计要求 无人机是一个典型的非线性 多通道耦合 多输入多输出复杂系统 因此为了满足不同飞 行任务的需要 对飞行控制系统提出了较高的要求 所以飞行控制系统性能的优劣是无人机能 否满足需要并成功投入使用的关键 无人机飞行控制系统基本要求如下 1 姿态航向保持控制 通过在无人机俯仰 横滚 航向三轴方向加入姿态闭环控制及角速率阻尼 改善其阻尼特 性及稳定性 保证无人机在其飞行包线内可控 2 高度控制 通过高度闭环控制 使无人机具有高度保持控制的能力 3 自主飞行控制 利用导航系统提供的位置 速度等导航信息完成预先设定或实时给定的任务航迹飞行 其 中包括直线自主飞行控制和圆周自主飞行控制 4 应急控制 在研制初期 控制系统还不完善 可能会出现无人机失控的情况 因而需要切换进入手控 模式进行应急控制 此外 在满足基本要求下 还应具备如下要求 1 在满足性能要求的情况下 应尽可能的降低其制造及选型成本 2 应简化各个模块 尽可能做到硬件结构简单和小型化 3 考虑飞行控制系统的工作环境 保证其能够持续稳定的工作 4 在硬件及软件上考虑扩展性 基于 stm32 单片机的无人机飞行控制系统设计 8 2 3 飞行控制系统试验平台 本文采用航模固定翼飞机作为无人机试验平台 为了能够满足飞行试验的需要提出了以下 要求 1 具有较高的可靠性 2 具有较好的可维护性 配件的购买和更换方便 便于外场试验 3 具有一定的负载安装空间 便于飞控 电池等设备的安装 4 具有一定的续航能力 提高外场飞行试验效率 本文无人机所采用的飞行平台是金星 40 级油动固定翼飞机如图 2 1 所示 其具体参数如 下 材 质 轻木 翼 展 1 50m 机身长度 1 14m 机身宽度 1 50m 螺旋桨直径 0 28m 通 道 4 通道 引 擎 40 级 重 量 2 2kg 续航时间 20min 图 2 1 金星 40 级油动固定翼 2 4 飞行控制系统总体方案设计 飞行控制系统是指以飞行控制计算机为核心 集成伺服舵机 机载传感器 配电以及地面 测控 形成一个资源统一调度分配 各部分相互协同运作的数字控制系统 本文基于数字化 小型化 低成本的思想 对微小型无人机飞行控制系统进行设计 为满足无人机飞行状态测量 南京航空航天大学硕士学位论文 9 控制律解算等任务的需要 飞行控制系统以微机械传感器和 gps 模块为基础 以 stm32f103ve 微控制器为核心飞控计算机 同时为了达到小型化的目的 将飞控计算机 传感器 数据采集系 统 电源模块等设计在一块主控电路板上 减小了飞控系统占用的空间 系统的总体结构如图 2 2 所示 主要包括机载飞控系统和地面测控系统两部分 图 2 2 飞行控制系统总体结构图 2 4 1 机载飞控系统 机载飞控系统主要包括 飞控计算机 传感器数据采集系统 gps 模块 遥控解码模块 舵机驱动子系统 数传电台及电源模块 实物图如下 图 2 3 机载飞控系统实物图 基于 stm32 单片机的无人机飞行控制系统设计 10 主控板电路原理图如下 图 2 4 主控电路板原理图 主要功能 1 通过数据链路上传控制指令和控制律参数 下传无人机导航及飞行状态信息 2 具有手动 自动切换的功能 一方面用于研制初期进行手控的飞行试验 另一方面用于 应对自主飞行时的突发情况 3 具有实时 高精度采集三轴陀螺 三轴加速度计 三轴磁强计等模拟或数字传感器数据 的能力 同时有预留的数字及模拟接口 用于后期扩展其他类型的传感器 4 对传感器信息进行滤波和解算 获得精确的姿态 速度 位置等导航信息 5 实现无人机姿态 航向保持 控制 高度保持 控制 自主飞行等模式的控制律解算 6 电源模块稳定输出 12v 5v 3 3v 等电平 满足不同模块的需要 2 4 2 地面测控系统 地面测控系统主要包括测控计算机 数传模块 地面监控主界面 发射机 主要功能如下 1 通过数据链路向机载飞控系统发送控制指令和控制参数 同时接收飞控系统下传的导航 及飞行状态等参数信息 2 使用发射机发送手动遥控信号 3 地面站软件应具有良好的人机界面 能够进行清晰的显示导航信息 有较好的人机交互 能力 4 完成飞行数据记录的功能 5 完成控制律参数的在线调试功能 南京航空航天大学硕士学位论文 11 图 2 5 地面站软件人机界面 如图 2 5 所示为地面测控系统的地面站软件 它主要包括地平仪 航向显示 动态数据显 示 位置显示 gps 数据显示 数据记录 遥控数据显示 控制律参数调整和串口设置几部分 本文使用 vc 6 0 完成基于 mfc 对话框软件的编写 其中串口数据通讯使用 mscomm 控件完成 动态数据显示使用开源的 multi line chart 类 位置显示使用 gms 控件 地平仪使用 adi 虚拟 仪表控件 2 5 飞行控制系统硬件方案 2 5 1 嵌入式飞控计算机 飞控计算机是飞行控制系统的核心 它担负着系统数据的采集 航姿估计 控制律解算和 飞行任务管理等重要任务 飞控计算机随着飞行控制系统功能的日益增多 飞行包线的不断扩 大 飞行任务的逐渐复杂 需要基于先进的全数字式思想进行飞行控制系统的设计 在无人机 工程实践中已经广泛采用了以数字计算机为基础的扩充性良好的飞行控制计算机 对于飞控计算机选型 在遵循小型化 低功耗的原则上 必须考虑具有有较快的计算能力 满足复杂数字计算和任务管理的需要 同时还需要具有丰富的数字及模拟外设接口 满足飞控 系统的需要和后期扩展 在考虑以上前提下 本文选择了基于cortex m3内核的stm32f103ve微控制器作为飞控计算 机 基于cortex m3内核的微控制器是最新一代的嵌入式arm微控制器 为实现mcu的需要提供了 低成本的平台 缩减的引脚数目 降低的系统功耗 同时提供卓越的计算性能和先进的中断系 统响应 特色的内置嵌套的向量式中断控制器 能够处理多达43个可屏蔽中断通道和16个优先 级 使得微控制器可以用最小的中断延迟提供灵活的中断管理功能 其具体性能指标如下 基于 stm32 单片机的无人机飞行控制系统设计 12 1 内核 最高72mhz工作频率 在存储器的0等待周期访问时可达1 25dmips mhz 单周期乘法和硬件除法 2 存储器 512k的闪存程序存储器 64k字节的sram 3 时钟 电源 4 16mhz晶体振荡器 产生cpu时钟的pll 2 0 3 6伏供电和i o引脚 4 模数转换 1us 转换时间 16 个输入通道 0 至 3 6v 转换范围 5 dma 7 通道 dma 控制器 支持定时器 adc spi i2c usart 等外设 6 i o 端口 多达 80 个 i o 口 所有 i o 都可以映射到 16 个外部中断 几乎所有端口都可以容忍 5v 7 定时器 4 个 16 位普通定时器 2 个 16 位高级定时器 8 通讯接口 2 个 i2c 接口 5 个串行接口 3 个 spi 接口 1 个 can 接口 1 个 usb2 0 接口 2 5 2 传感器数据采集 本文涉及的传感器有微机械陀螺仪 加速度计及磁强计 分别用于测量无人机角速率 加 速度及磁场矢量信息 无人机的导航算法是以上述传感器信息为基础 完成姿态 速度等导航 信息的滤波解算 快速 高精度的硬件数据采集系统是保证导航算法精度 带宽等指标的必要 条件 本文选用了 ti 公司的十六位模数转换芯片 ads8344 进行模拟数据的采集 其转换速率达 100khz 同时有八个通道 模拟量输入范围为 0 5v 能够满足本文数据采集系统的需要 南京航空航天大学硕士学位论文 13 图 2 6 传感器数据采集系统硬件结构图 1 陀螺仪选型及信号调理电路 角速率传感器选用的是 crs03 微机械陀螺 它是一种利用 coriolis 效应的单轴固态速率陀 螺 采用硅素震动环状设计 因而可以而产生一个正比于旋转速度的精确模拟直流电压输出 同时 由于独特的平面环状结构 受震动和冲击的影响较好小 此外还具有较好的温度漂移特 性 其性能指标如下 表 2 1 角速率传感器性能指标 测量范围 100 s 分辨率 0 05 s 非线性度 0 5 fs 比例因子 20mv s 供电电压 5v 带宽 大于 10hz 工作温度 40 85 冲击 200g 无人机在实际飞行过程中一般不会出现过大的角速率 因而陀螺仪输出的直流模拟电压范 围较小 为了提高测量精度 本文设计了如图 2 7 所示运算放大电路 放大系数为 2 图中 c1 和 r3 组成低通滤波器 截止频率为 15hz 能够降低高频噪声和避免信号采集的混叠现象 同 时为了提高输入阻抗 在运放电路的前端设计一个跟随器 基于 stm32 单片机的无人机飞行控制系统设计 14 图 2 7 角速率陀螺信号调理电路 2 加速度计选型及信号调理电路 加速度计传感器选用adi公司的双轴加速度计adxl202 它既可测量动态加速度 又可测量 静态加速度 具有低成本 低功耗 精度高等特点 其内部电路脉宽占空调节器将模拟信号转 换为数字信号 并且占空比周期t2可通过setr调节 同时输出带宽也可通过电容xc yc进行 调整 其功能结构图如下 图 2 8 adxl202 加速度计功能结构图 脉宽周期与setr的关系为 mrtset125 2 xc yc与输出带宽关系为 322 1 202yxckf 具体性能指标如下 表 2 2 加速度计传感器性能指标 测量范围 2g 非线性度 0 2 fs 比例因子 312mv g 供电电压 5v 带宽 0 01 5khz 工作温度 40 85 冲击 1000g 南京航空航天大学硕士学位论文 15 其信号调理电路采用与图 2 7 相同的方案 设计放大系数为 2 低通滤波截止频率为 15hz 3 磁强计 磁强计是测量地磁矢量在无人机体轴系下分量的器件 本文使用 pni 公司的 11096 磁强测 量模块和 sen l 磁电感进行组合设计 相对于磁阻式 磁感式类型的传感器具有更高的灵敏度 及更好的温度漂移特性 其具体性能指标如下 表 2 3 磁强测量模块性能指标 测量范围 5 5gauss 供电电压 2 2 5v 带宽 最大 2khz 功耗 0 5ma at 3v 该型测量模块采用常用的 spi 接口 能够非常方便地进行数据采集 如图 2 9 所示为设计 的磁强计模块 图 2 9 磁强计模块 2 5 3 gps 模块 在进行导航滤波计算时 需要将 gps 模块输出的速度 经纬度等信息作为量测值 本文基 于 ublox 出产的芯片设计了 gps 接收模块 该芯片具有定位精度高 弱信号快速捕捉能力强 搜星快等特点 进行 gps 接收模块电路设计时 要求天线信号线的特性阻抗为 50 欧姆 人工计 算繁琐 较容易出错 本文使用射频设计软件 appcad 进行电路的设计 实现了天线的阻抗匹配 本文设计的 gps 模块实物图如下 图 2 10 gps 模块 基于 stm32 单片机的无人机飞行控制系统设计 16 gps 模块电路原理图如下 图 2 11 gps 模块电路原理图 2 5 4 遥控解码模块 手动遥控的参与在整个无人机飞行控制系统的研制过程中是不可或缺的 一方面在研制初 期通过将手动遥控信号混控到到飞控系统操纵中 实现手动飞行 令一方面 在进行自主飞行 试验遇到紧急情况时 可快速切换到手动操纵 进行紧急处理 降低飞行试验风险 本文采用 基于 at89s52 单片机的遥控解码模块对机载九通道接收机输出的遥控信号进行解码 在完成解 码后对数据进行打包通过串口发送到飞控计算机 由于 at89s52 单片机内部资源有限 该模块 使用了具有三通道可编程的十六位定时器芯片 完成高精度的信号解码任务 该模块硬件实物 图如下 图 2 12 遥控解码模块 2 5 5 舵机驱动子系统 舵机是无人机的执行机构 可靠的舵机驱动系统是无人机关键技术之一 本文飞行平台采 用的是高精度的数字舵机 通过调整脉宽调制信号即可实现其操作控制 舵机的脉宽调制信号 南京航空航天大学硕士学位论文 17 更新周期为 70hz 高电平为 1 2ms 利用 stm32 微控制器内部十六位定时器的 pwm 输出模式 实现舵机驱动 由于 stm32 微控制器的 io 口为 3 3v 电平 同时也为了避免舵机与微控制器之 间的干扰 使用 74lvc245 芯片实现电平转换和信号隔离 2 5 6 数传电台 数传电台是实现机载飞控系统与地面测控系统的可靠通信保证 通过数传电台可以实现导 航信息 机载传感器状态等信息的下传及控制律参数 控制指令信息的上传 本文选用频率为 900mhz 的数传电台完成上述任务 其具体性能指标如下 表 2 4 数传电台性能指标 传输距离 22km 传输速率 10 230400bps 接收电流 80ma 发送电流 270ma 发射功率 100mw 频率范围 902 928mhz 支持方式 点对点 点对多对等网 工作电压 2 8 5 5v 2 5 7 电源模块 为满足飞控系统需要 电源模块提供了 12v 5v 和 3 3v 电平 通过 dc dc 芯片实现将 12v 电平一级降压为 5v 为数据采集系统 gps 模块 遥控解码模块 接收机等提供电源 再通过 二级电平转换得到 3 3v 为飞控计算机核心电路等提供电源 其中 12v 电源采用 3s 锂电池提供 持续的电能 由于舵机功耗较大 本文采用单独的 5v 镍镉电池对其供电 2 6 飞行控制系统软件设计 2 6 1 飞行控制系统软件设计需求 根据飞行控制系统的设计要求 将机载飞控系统软件任务划分为以下几部分 1 初始化任务 完成系统 外设及相关数据变量的初始化工作 2 数据通讯任务 通过数传电台完成数据的下传 上传 3 遥控数据解码任务 对解码模块发来的数据进行解包 更新手动操纵变量 4 数据采集任务 完成陀螺仪 加速度计及磁强计的数据采集工作 5 gps 解码任务 采集串口来的 gps 数据 根据标准的数据协议 进行解码 基于 stm32 单片机的无人机飞行控制系统设计 18 6 导航滤波解算任务 进行姿态 速度 位置导航滤波解算 7 控制律解算任务 进行无人机的控制律解算 更新舵机控制量 可见机载飞控计算的工作量较大 所以需要合理的安排各个任务时序 尽可能的提高飞控 计算机的计算效率 2 6 2 飞行控制系统软件流程 基于上述任务需求 在 keil 集成开发环境下 采用前 后台软件设计方法进行飞行控制系 统软件设计 该方法将应用程序作为一个无限循环 循环中调用各个功能函数 而与时间相关 性很强的应用放在中断中执行 利用 stm32f103ve 微控制器内部十六位定时器设置 20ms 中断完 成数据采集 导航滤波解算 控制律解算等任务 100ms 中断更新是否发送数据状态标志 此 外 遥控数据解码任务 gps 解码任务是在直接存储控制器中断和串口中断中完成 如图 2 13 所示为主程序流程图 图 2 13 主程序流程图 南京航空航天大学硕士学位论文 19 硬件初始化任务主要是对系统时钟 嵌套中断控制器 定时器 同步串口 异步串口 直 接存储控制器等进行初始化 参数初始化任务主要是对控制律参数 滤波器参数 标志变量等 进行初始化 飞行控制系统软件的核心任务是在 20ms 定时器中断中进行的 程序流程图如下 图 2 14 20ms 定时器中断程序流程图 数据采集任务通过两个异步串口分别读取片外 ad 和磁强计传感器 获得角速率 加速度和 磁场矢量数据 在此基础上进行导航滤波解算 然后 判断飞行模式标志 进入相应飞行模式 完成舵量解算 结束程序 基于 stm32 单片机的无人机飞行控制系统设计 20 第三章 基于单片机的捷联导航算法研究 3 1 引言 如何获取精确的姿态 速度 位置等导航信息是实现无人机飞行控制的关键 具有高精度 易实现的导航算法一直是人们关注的热点 无人机的捷联导航算法通常以微机械陀螺 加速度 计 磁强计等传感器为基础 在一定的数学平台上构件构建导航参数测量系统 同时利用气压 计 gps 等对速度和位置信息进行推算 通常采用信息融合方法获得精确的导航信息 例如互补滤波器 线性卡尔曼滤波 扩展卡 尔曼滤波等方法 文献 9 中设计了重力场和磁矢量场的互补滤波器 完成了姿态估计 文献 10 设计了基于四元数的非线性状态方程 并利用扩展卡尔曼滤波器完成系统的姿态估计 本章对 适用于单片机平台的导航滤波算法进行了研究 首先研究了捷联姿态矩阵更新算法 建立了传 感器的误差模型 设计了基于误差四元数的卡尔曼滤波器 通过滤波补偿姿态误差 其次 针 对大机动飞行 采用组合滤波方法减小刚体加速度的影响 并进行了数值仿真 再次 在姿态 估计基础上设计了速度和位置卡尔曼滤波器 采用了分级式的组合方式 利用 gps 输出的信息 进行速度与位置解算 3 2 坐标系定义及变换 常用的坐标系为 北 东 地 坐标系 nx轴和ny轴分别指向北向和东向 导航坐标系是按 照右手法则的坐标系 nz轴指向当地 重力垂线 g 的方向 机体坐标系是与机体固连 圆点为飞机重心 纵轴 0x 在无人机对称平面内 通过重心与 机体纵轴一致 沿机头方向为正 立轴 0z 通过重心 在对称平面内向下为正 横轴 oy 通过 重心与 xoz 平面垂直 按右手定则 指向右为正 图 3 1 机体坐标系与导航坐标系的关系 南京航空航天大学硕士学位论文 21 由图 3 1 可知 机体坐标系与导航坐标系的关系可由三个欧拉角 来表示 首先 绕 oz 轴转过一个偏航角 右偏为正 构成nzyox 在绕 oy 转动 则出现俯仰角 抬 头为正 构成 oxy z 轴系 最后绕 ox 轴转动 得到横滚角 右滚为正 实现导航坐标系到 机体坐标系的转换矩阵为 b n c 所以有 z y x c z y x b n b b b 3 1 其中 100 0cossin 0sincos cos0sin 010 sin0cos cossin0 sincos0 001 b n c co sco sco ss ins ins inco ss ins inco ss inco s co ss inco sco ss ins ins ins inco sco ss ins in s ins inco sco sco s 333231 232221 131211 ttt ttt ttt 3 2 则可推导出欧拉角 33 23 arctant t 3 3 13 arcsint 3 4 11 12 arctant t 3 5 其中 b n c也称为姿态矩阵 由 b n c可计算姿态角 3 3 捷联姿态矩阵更新算法 捷联式惯性导航是把与机体固连的惯性器件所测量的飞行器的运动信息经过计算机处理成 所需要的导航和控制信息 而姿态矩阵更新是捷联式惯导算法中最重要的一部分 也是捷联系 统所特有的 11 在捷联式惯导中 飞行器的姿态是机体坐标系相对导航坐标系决定的 而描述 坐标系的方法有很多种 可分作三类 即三参数法 四参数法 九参数法 11 三参数法也叫欧 基于 stm32 单片机的无人机飞行控制系统设计 22 拉角法 是欧拉在 1776 年提出的 四参数法有四元数法 九参数法为方向余弦法 还有一种基 于动坐标系相对参考坐标系转动的等效转轴和转角来描述刚体定点转动的方法 叫等效旋转矢 量法 其中通过欧拉角法得到的姿

温馨提示

  • 1. 本站所有资源如无特殊说明,都需要本地电脑安装OFFICE2007和PDF阅读器。图纸软件为CAD,CAXA,PROE,UG,SolidWorks等.压缩文件请下载最新的WinRAR软件解压。
  • 2. 本站的文档不包含任何第三方提供的附件图纸等,如果需要附件,请联系上传者。文件的所有权益归上传用户所有。
  • 3. 本站RAR压缩包中若带图纸,网页内容里面会有图纸预览,若没有图纸预览就没有图纸。
  • 4. 未经权益所有人同意不得将文件中的内容挪作商业或盈利用途。
  • 5. 人人文库网仅提供信息存储空间,仅对用户上传内容的表现方式做保护处理,对用户上传分享的文档内容本身不做任何修改或编辑,并不能对任何下载内容负责。
  • 6. 下载文件中如有侵权或不适当内容,请与我们联系,我们立即纠正。
  • 7. 本站不保证下载资源的准确性、安全性和完整性, 同时也不承担用户因使用这些下载资源对自己和他人造成任何形式的伤害或损失。

评论

0/150

提交评论