1. 项目概述从赛题到四旋翼飞行器2020年江苏省大学生电子设计竞赛的D题是一个典型的综合性工程实践项目要求参赛队伍在限定时间内从零开始设计并制作一架能够完成特定任务的四旋翼飞行器。这不仅仅是“造一架能飞的无人机”那么简单它是对参赛者嵌入式系统开发、自动控制理论、传感器融合、机械结构设计以及团队协作能力的全方位考验。题目通常会设定一个具体的应用场景比如定点悬停、循迹飞行、目标识别与追踪、或者物资投送等这就要求飞行器不仅要“飞得起来”更要“飞得精准”、“飞得智能”。我当年带队参加这个比赛从拿到赛题到最终提交作品前后经历了方案论证、硬件选型、软件编写、整机调试和现场测试等多个阶段其中踩过的坑、获得的经验远比课本上学到的要深刻得多。这篇总结就是想从一个一线参赛者的视角把整个项目的核心脉络、关键技术点以及那些“只有做过才知道”的实操细节系统地梳理出来。无论你是正在备赛的电赛新人还是对无人机开发感兴趣的嵌入式爱好者希望这些从实战中沉淀下来的内容能为你提供一个清晰、可复现的参考框架。2. 核心需求解析与总体方案设计2.1 赛题任务拆解与指标定义拿到赛题后第一步绝不是立刻开始画电路图或写代码而是必须像做阅读理解一样逐字逐句地分析任务书。以当年我们遇到的典型任务为例其核心要求可能包括基础飞行能力飞行器需能从地面自主起飞稳定悬停在指定高度如1.5米并能接收指令完成前后、左右、偏航的机动。自主导航能力在悬停基础上可能需要飞行器按照预设的航线如矩形、8字形飞行或者通过机载摄像头识别地面标识进行循迹。任务执行能力这可能涉及用机械臂或电磁铁抓取/投放小物体或者通过图传识别特定目标并保持跟踪。稳定性与鲁棒性指标悬停时的高度波动范围如±10厘米、位置保持精度、抗微风干扰能力、续航时间等这些都是评分的硬性指标。关键点必须将模糊的赛题描述转化为可量化、可测量的工程指标。例如“稳定悬停”需要明确是仅靠气压计还是需要引入超声波或激光测距进行高度闭环“循迹”需要明确是识别颜色线条还是二维码以及识别帧率和处理延迟要求。这一步的清晰与否直接决定了后续所有硬件选型和算法设计的边界。2.2 系统总体架构设计基于明确的需求我们设计了经典的“感知-决策-控制-执行”四层系统架构。这是四旋翼乃至大多数机器人的通用框架。感知层负责收集飞行器自身状态和外部环境信息。自身状态感知这是核心。我们采用了MPU6050六轴陀螺仪加速度计作为姿态感知的主力。它价格低廉、集成度高能提供三轴加速度和三轴角速度数据是解算飞行器俯仰、横滚角度的基础。为了补偿其漂移我们引入了HMC5883L三轴磁力计来提供航向角参考。高度信息则通过MS5611高精度气压计获取对于低空精细定高额外增加了US-100超声波测距模块。环境任务感知根据任务需求选配。我们使用了OpenMV Cam或树莓派摄像头模块作为视觉传感器用于识别地面色块或AprilTag标签。如果需要更复杂的图像处理则会选用算力更强的平台。决策层核心是飞行控制主控。我们选择了STM32F4系列MCU如F405或F407。理由很充分它拥有Cortex-M4内核带硬件浮点运算单元FPU这对于需要大量矩阵运算的姿态解算和PID控制来说是巨大的性能提升主频高达168MHz足以应对多传感器数据融合和实时控制任务外设丰富拥有多个SPI、I2C、UART接口方便连接各类传感器生态成熟有HAL库和标准库开发调试工具链完善。控制层这是算法的落脚点。主要运行两个核心算法姿态解算算法将MPU6050的原始数据融合磁力计数据解算成可靠的欧拉角俯仰、横滚、偏航。我们采用了Mahony互补滤波或卡尔曼滤波。Mahony算法参数直观在MCU上实现简单资源消耗小对于电赛级别的精度要求完全足够。卡尔曼滤波更优但更复杂。PID控制算法这是让飞机“听话”的大脑。我们采用了串级PID控制结构。内环角速度环负责快速响应抑制扰动外环角度环负责精准定位。油门单独用一个PID控制器进行高度控制。执行层将控制量转化为实际的动力。电调ESC我们选用支持PWM信号输入或更优的DShot协议的电调。DShot是数字协议比传统的PWM响应更快、分辨率更高、抗干扰更好。电机与桨叶根据飞机轴距和重量我们选择了2205或2306尺寸的无刷电机搭配5045或6040的三叶桨。电机KV值的选择需要与电池电压和桨叶匹配以确保有足够的推力裕度推重比最好大于2:1。机架与电源采用碳纤维机架保证强度与轻量化。电源使用3S或4S锂聚合物电池并搭配电源管理模块PDB为整个系统提供稳定的5V和12V电压。注意总体设计阶段必须考虑重量预算每一个模块、每一根线缆的重量都要估算。超重是性能的第一杀手。我们的原则是在满足功能和可靠性的前提下选用最轻的组件。3. 硬件系统搭建与核心模块解析3.1 飞控核心板设计与传感器集成飞控板是飞行器的大脑我们选择了自制核心板而非直接购买成品飞控这既能深度定制也是电赛考核的重要能力。主控电路围绕STM32F407设计最小系统包括晶振、复位电路、Boot模式选择电路和调试接口SWD。电源部分使用AMS1117-3.3和MP2359等芯片将电池电压逐步降压至5V和3.3V并为模拟传感器部分设计了LC滤波电路最大限度减少电源噪声对传感器读数的影响。传感器电路布局MPU6050通过I2C接口连接。其AD0引脚的电平决定了I2C设备地址这在多个I2C设备共存时需要注意。我们将其单独放在一块小板上通过排针与主控板连接并尽量远离电机和电源线以减少振动和电磁干扰。HMC5883L同样通过I2C连接。磁力计对电磁环境极其敏感必须远离所有大电流线路特别是电池线、电机线。我们最终将其布置在机臂的末端这是整机磁场干扰相对较小的位置。MS5611气压计使用I2C或SPI。关键是要用海绵或软性泡棉将其包裹起来隔离气流扰动导致的压力骤变否则高度数据会跳变剧烈。我们将其放在飞控板的中心位置并开了个小孔让静态空气可以缓慢流通。超声波模块朝向地面安装。需要注意的是超声波在近地面30cm时可能会因地面材质如光滑的赛台产生多次反射导致测距不准。我们为其编写了简单的数据滤波算法如滑动平均。通信接口预留了多个UART分别用于连接数传电台与地面站通信、视觉模块如OpenMV以及GPS模块如果赛题需要。SPI接口则用于连接SD卡存储飞行数据日志用于后期分析和无线模块的某些型号。3.2 动力系统选型与供电设计动力系统直接决定飞行器的“力气”和“耐力”。电机、电调与桨的匹配这是一个迭代过程。我们先估算整机重量包括所有硬件和电池假设为800克。对于四旋翼所需总推力至少应为重量的1.5倍悬停到2倍以上机动即至少需要1200克推力单个电机需提供300克以上推力。查阅电机厂商提供的推力数据表在3S电压11.1V下一款2306 2400KV电机搭配6040三叶桨可能能提供约400克推力四台合计1600克推重比达到2:1满足要求。电调选择与之电流匹配的通常留有余量例如电机最大电流20A则选用30A电调。电池与电源管理电池选择容量mAh决定续航放电倍率C数决定爆发力。我们选用3S 2200mAh 45C的电池。续航粗略估算假设整机悬停电流为15A则理论续航时间为2.2Ah / 15A * 60分钟 ≈ 8.8分钟扣除起降和安全余量实际有效任务时间约5-6分钟这对电赛任务通常是足够的。PDB分电板设计自制PDB不仅分配电力更是安全关键。我们确保电池输入端有XT60接口并并联一个大容量如470μF 35V的电解电容来吸收电调工作时产生的瞬间大电流脉冲防止电压骤降导致飞控重启。每个电调的输出焊盘都做了敷铜加粗处理。同时PDB上集成了5V和3.3V的BEC稳压输出为飞控和传感器供电。机架与装配选用轻量化的碳纤维机架。装配时所有螺丝都使用螺丝胶低强度防止飞行振动导致松动。电机安装必须确保水平任何微小的倾角都会在控制上引入常值偏差。我们使用水平仪仔细校准。线缆用扎带和热缩管固定避免与桨叶干涉。实操心得在焊接电调与PDB、电机与电调的连接时务必先做好绝缘热缩管并且逐个焊接焊完一个立即套上热缩管吹紧再进行下一个。绝对不要把所有线都焊好了再一起处理绝缘极易发生短路烧毁电调或PDB这是我们用一块冒烟的PDB换来的教训。4. 软件算法实现与飞控程序编写4.1 传感器数据读取与滤波处理原始传感器数据噪声很大必须经过处理才能使用。驱动程序编写为每个传感器编写基于STM32 HAL库的I2C/SPI读写驱动程序。关键点在于处理通信超时和校验。例如MPU6050上电后需要等待一段时间约100ms才能稳定读取数据读取时先读其“WHO_AM_I”寄存器进行设备校验。数据预处理校准这是最重要的一步。加速度计和陀螺仪需要做六面校准采集每个轴正反方向的静态数据计算零偏和比例因子。磁力计需要做八字校准以消除硬铁和软铁干扰。校准数据应存储在Flash中上电后加载。低通滤波对于加速度计数据我们使用一阶低通滤波来抑制高频振动噪声。公式简单filtered_data a * raw_data (1-a) * last_filtered_data其中a是滤波系数0 a 1取值小则平滑但延迟大。滑动平均对于超声波等更新较慢、偶尔跳变的数据采用滑动平均滤波保留最近N次采样值求平均。// 示例一阶低通滤波的简单实现 float low_pass_filter(float new_value, float old_value, float alpha) { return alpha * new_value (1 - alpha) * old_value; } // 在姿态解算循环中调用 accel_filtered_x low_pass_filter(accel_raw_x, accel_filtered_x, 0.2f);4.2 姿态解算从数据到角度我们选择了资源消耗和效果平衡较好的Mahony互补滤波算法。其核心思想是利用陀螺仪积分得到角度动态响应好但会漂移利用加速度计和磁力计观测得到角度静态准确但动态噪声大通过一个PI控制器将两者的误差融合起来修正陀螺仪的漂移。初始化上电后飞机需静止放置数秒利用此时的加速度计数据理论上应为[0, 0, g]和磁力计数据初始化四元数。主循环读取陀螺仪角速度弧度/秒。利用当前四元数将加速度计和磁力计的测量向量从机体坐标系转换到地球坐标系。计算转换后的加速度计向量与理论重力向量[0,0,1]的误差叉乘同样计算磁力计向量与理论地磁向量的误差。将这两个误差加权后通过一个PI控制器生成对陀螺仪读数的修正量。用修正后的角速度进行四元数更新积分。最后将四元数转换为欧拉角俯仰、横滚、偏航供PID控制器使用。// Mahony算法核心步骤伪代码 void MahonyAHRSupdate(float gx, float gy, float gz, float ax, float ay, float az, float mx, float my, float mz) { // 1. 归一化加速度计和磁力计数据 // 2. 计算误差叉积 // 3. 积分误差到陀螺仪偏差修正 exInt Ki * ex * dt; // 4. 应用修正 gx Kp * ex exInt; // 5. 四元数更新一阶龙格库塔法 q0 0.5f * dt * (-q1*gx - q2*gy - q3*gz); // ... 更新q1, q2, q3 // 6. 四元数归一化 }注意事项Mahony算法中的两个关键参数Kp和Ki需要调试。Kp决定了对传感器观测值的信任程度太大飞机会“僵硬”响应慢太小则容易漂移。Ki用于消除静态误差通常设为一个很小的值。我们的经验是从Kp2.0, Ki0.001开始调。4.3 串级PID控制器设计与调参串级PID是飞行控制的核心我们以内环为角速度环外环为角度环为例。角度环外环输入期望角度来自遥控器或自主导航与当前估计角度的误差。输出期望的角速度。作用让飞机达到并保持某个姿态。P参数起主要作用I参数消除静差如因电机安装不平或机架不对称导致的微小常值偏差D参数通常较小用于抑制超调。角速度环内环输入角度环输出的期望角速度与当前陀螺仪测量的角速度的误差。输出直接作用于四个电机的PWM控制量或力矩。作用快速响应抵抗外界扰动如一阵风。这个环需要更高的控制频率我们通常用500HzP和D参数是关键I参数可以很小甚至为0。调参步骤与口诀先内环后外环必须先把内环角速度环调稳定飞机才有调外环的基础。先比例P后微分D再积分I将I和D设为0逐渐增大P直到飞机出现高频振荡“抖”然后将P回调到振荡消失的70%-80%。加微分D逐渐增加D能有效抑制振荡让飞机反应更“跟手”。但D过大会引入高频噪声可能引发电机发热。最后加积分I外环的I用于消除角度静差内环的I通常不需要。I值要非常小慢慢增加观察飞机能否在干扰后准确回到原点。口诀“P是基础决定响应速度D是镇定抑制振荡I是修正消除余差”。调试现场记录我们将PID参数存储在Flash中并通过数传电台实时发送到上位机如匿名地面站进行波形显示。在调试时用手轻轻拨动飞机观察角度和角速度的响应曲线。理想的曲线应该是快速上升、超调小、平稳收敛。我们曾因D值过大导致电机产生刺耳的高频噪音同时电机异常发热这就是典型的“D过敏”现象。5. 任务功能实现与系统集成5.1 基于视觉的自主导航实现我们的赛题要求识别地面色块进行循迹。我们选用OpenMV Cam因为它内置了色块识别算法开发简单。视觉处理流程图像采集与预处理OpenMV设置合适的分辨率和帧率如QQVGA 160x120 30fps进行镜头校正消除畸变。色块识别利用find_blobs函数根据HSV颜色阈值寻找目标色块。关键是要在现场光照条件下重新标定HSV阈值实验室的光照和赛场往往差异巨大。位置信息提取获取色块的中心点像素坐标(cx, cy)和像素面积(pixel_area)。坐标转换将像素坐标转换为飞机机体坐标系下的位置偏差。我们采用简单的比例映射假设摄像头视野范围对应实际物理距离则横向偏差error_x (cx - image_width/2) * scale_factor。高度信息则通过色块面积进行粗略估计面积大则离得近。控制融合视觉解算出的error_x和error_y作为新的期望位置输入到位置PID控制器中。位置PID的输出作为角度环的期望角度从而形成“位置-角度-角速度”的三级串级控制。为了防止视觉数据丢失如色块短暂离开视野导致控制失效我们加入了数据有效性判断和失效保持逻辑。当连续N帧未找到色块时切换为保持上一时刻的有效指令或进入悬停模式。# OpenMV 端简化代码示例 import sensor, image, time sensor.reset() sensor.set_pixformat(sensor.RGB565) sensor.set_framesize(sensor.QQVGA) sensor.skip_frames(time 2000) uart UART(3, 115200) # 与飞控通信 while(True): img sensor.snapshot() blobs img.find_blobs([red_threshold]) # 红色色块 if blobs: max_blob max(blobs, keylambda b: b.pixels()) cx max_blob.cx() cy max_blob.cy() # 计算偏差并发送给飞控 error_x cx - 80 # 图像中心x80 error_y cy - 60 # 图像中心y60 uart.write(%d,%d\n % (error_x, error_y)) else: uart.write(lost\n) # 发送丢失信号5.2 无线通信与地面站监控我们使用NRF24L01PALNA无线模块或Si24R1等增强型2.4G模块进行双向通信。通信协议设计自定义一个轻量级的帧结构包含帧头、数据长度、命令字、数据载荷和校验和如CRC8。数据载荷打包飞控的姿态、传感器原始数据、PID参数等下传数据包则包含遥控指令、参数修改命令等。地面站软件使用匿名地面站、QT自行编写或利用现成的软件。核心功能是数据可视化波形显示姿态角、高度、电机输出等曲线这是调参的眼睛。参数在线调试能实时修改PID参数并立即生效无需重新烧录程序极大提升调试效率。虚拟仪表盘显示飞机状态如电池电压、信号强度等。遥控器解码使用一个独立的接收机如PPM接收机或另一路无线通信解析来自遥控器的信号生成期望的姿态和油门指令。我们实现了失控保护功能当超过一定时间未收到遥控信号时飞机自动进入缓慢降落或定点悬停模式。6. 系统调试、问题排查与竞赛心得6.1 飞行测试流程与安全规范调试必须遵循从易到难、从安全到风险的流程。实验室台架测试用绳子或测试架将飞机悬空固定。首先测试遥控器通道映射是否正确电机转向是否正确对角线电机转向相同相邻电机转向相反。然后解锁电机缓慢推油门观察电机是否平稳加速有无异响。系留悬停测试在开阔、柔软的场地如草坪用一根长绳将飞机轻系在地面桩上。进行低空离地20-30厘米悬停测试。重点观察解锁后是否自旋如果自旋说明偏航角速度环的P值需要调整或者电机转向/桨叶装反。是否向一个方向漂移如果漂移可能是加速度计未校准好或者机架不水平。微调遥控器微调或软件角度偏移进行补偿。悬停是否稳定调整角度环PID。自由飞行测试在系留测试稳定后进行短时间、低高度的自由飞行。先练习手动模式下的起降和简单机动再尝试自稳模式最后测试自主任务模式。安全第一任何时候测试桨叶必须安装牢固周围不能有人。电池充电必须在安全箱内进行。飞行时操作者与飞机保持安全距离并随时准备切到手动模式或紧急断电。6.2 典型问题排查速查表问题现象可能原因排查步骤与解决方案上电后飞控无反应1. 电源接反或电压不对。2. Boot引脚配置错误未进入用户程序。3. 晶振不起振。1. 检查电源电压和极性用万用表测量3.3V和5V点。2. 检查BOOT0和BOOT1引脚电平确保为运行模式通常都接地。3. 更换晶振或检查负载电容。MPU6050读不出数据1. I2C地址错误。2. 电源噪声大。3. 上电初始化时序不对。1. 检查AD0引脚电平用逻辑分析仪抓取I2C波形。2. 在电源引脚加滤波电容。3. 上电后延时100ms再进行首次读取。飞机解锁后剧烈抖动或“跳舞”1. 电机排序或转向错误。2. 陀螺仪数据极性错误正负号反了。3. PID参数尤其是角速度环的P值过大。1. 重新检查电机顺序1-4号和转向。2. 检查MPU6050的安装方向在软件中修正坐标系。3. 大幅降低内环P值重新从很小值开始调。飞机自旋偏航不稳定1. 偏航角速度环PID未调好。2. 电机推力不平衡个别电机或电调有问题。3. 机架不对称或重心不在中心。1. 单独调试偏航角速度环确保能快速抑制手动旋转。2. 用电机测试仪检查每个电机在相同油门下的推力是否一致。3. 调整电池或设备位置使重心居中。悬停时高度上下波动“呼吸”高度环PID参数不佳通常是P太大或D太小。降低高度环的P值适当增加D值。检查气压计数据是否平稳加海绵隔离气流。视觉循迹时飞机晃动严重1. 视觉处理延迟过大。2. 位置环PID参数过于激进。3. 图像识别不稳定坐标跳动。1. 降低图像分辨率或优化算法减少处理时间。2. 降低位置环的P值增加一些阻尼D值。3. 对识别到的坐标进行低通滤波。飞行几分钟后突然失控1. 电池电量耗尽电压过低导致电调或飞控重启。2. 无线信号受到干扰。3. 电机或电调过热保护。1. 设置电池低压报警并在软件中监测电压低于阈值自动降落。2. 更换通信频道或使用频率跳频模块。3. 确保电机和电调散热良好检查桨叶是否碰伤导致不平衡。6.3 竞赛现场应对策略环境适应赛场光线、磁场、地面材质都可能与实验室不同。预留至少1小时进行现场校准和参数微调。重新校准加速度计、磁力计重新标定视觉识别的颜色阈值。冗余设计准备备用机、备用核心模块如飞控板、传感器。关键连接点如电池插头使用防松脱接口。流程化操作制定标准的起飞前检查清单如电池电压、遥控器信号、传感器状态、螺旋桨紧固并由非操作队员逐项核对避免因紧张导致的低级失误。心态管理出现问题时按部就班地排查从最可能的电源、连接线开始。如果一次飞行失败不要急于下一次冷静分析数据日志如果记录了的话或现场现象。从电路板上的第一个焊点到飞行器平稳完成赛道任务整个电赛项目是一次浓缩的、高强度的产品开发演练。它教会你的远不止PID调参和画电路图更是如何将理论转化为实践如何在资源、时间受限的压力下进行工程决策以及如何与队友高效协作。最大的收获往往来自于解决那些未曾预料到的问题比如深夜调试时发现的一个硬件虚焊或是算法中一个正负号的错误。这些经历比任何奖状都更为珍贵。
从零打造竞赛级四旋翼：STM32飞控、PID调参与视觉循迹全解析
1. 项目概述从赛题到四旋翼飞行器2020年江苏省大学生电子设计竞赛的D题是一个典型的综合性工程实践项目要求参赛队伍在限定时间内从零开始设计并制作一架能够完成特定任务的四旋翼飞行器。这不仅仅是“造一架能飞的无人机”那么简单它是对参赛者嵌入式系统开发、自动控制理论、传感器融合、机械结构设计以及团队协作能力的全方位考验。题目通常会设定一个具体的应用场景比如定点悬停、循迹飞行、目标识别与追踪、或者物资投送等这就要求飞行器不仅要“飞得起来”更要“飞得精准”、“飞得智能”。我当年带队参加这个比赛从拿到赛题到最终提交作品前后经历了方案论证、硬件选型、软件编写、整机调试和现场测试等多个阶段其中踩过的坑、获得的经验远比课本上学到的要深刻得多。这篇总结就是想从一个一线参赛者的视角把整个项目的核心脉络、关键技术点以及那些“只有做过才知道”的实操细节系统地梳理出来。无论你是正在备赛的电赛新人还是对无人机开发感兴趣的嵌入式爱好者希望这些从实战中沉淀下来的内容能为你提供一个清晰、可复现的参考框架。2. 核心需求解析与总体方案设计2.1 赛题任务拆解与指标定义拿到赛题后第一步绝不是立刻开始画电路图或写代码而是必须像做阅读理解一样逐字逐句地分析任务书。以当年我们遇到的典型任务为例其核心要求可能包括基础飞行能力飞行器需能从地面自主起飞稳定悬停在指定高度如1.5米并能接收指令完成前后、左右、偏航的机动。自主导航能力在悬停基础上可能需要飞行器按照预设的航线如矩形、8字形飞行或者通过机载摄像头识别地面标识进行循迹。任务执行能力这可能涉及用机械臂或电磁铁抓取/投放小物体或者通过图传识别特定目标并保持跟踪。稳定性与鲁棒性指标悬停时的高度波动范围如±10厘米、位置保持精度、抗微风干扰能力、续航时间等这些都是评分的硬性指标。关键点必须将模糊的赛题描述转化为可量化、可测量的工程指标。例如“稳定悬停”需要明确是仅靠气压计还是需要引入超声波或激光测距进行高度闭环“循迹”需要明确是识别颜色线条还是二维码以及识别帧率和处理延迟要求。这一步的清晰与否直接决定了后续所有硬件选型和算法设计的边界。2.2 系统总体架构设计基于明确的需求我们设计了经典的“感知-决策-控制-执行”四层系统架构。这是四旋翼乃至大多数机器人的通用框架。感知层负责收集飞行器自身状态和外部环境信息。自身状态感知这是核心。我们采用了MPU6050六轴陀螺仪加速度计作为姿态感知的主力。它价格低廉、集成度高能提供三轴加速度和三轴角速度数据是解算飞行器俯仰、横滚角度的基础。为了补偿其漂移我们引入了HMC5883L三轴磁力计来提供航向角参考。高度信息则通过MS5611高精度气压计获取对于低空精细定高额外增加了US-100超声波测距模块。环境任务感知根据任务需求选配。我们使用了OpenMV Cam或树莓派摄像头模块作为视觉传感器用于识别地面色块或AprilTag标签。如果需要更复杂的图像处理则会选用算力更强的平台。决策层核心是飞行控制主控。我们选择了STM32F4系列MCU如F405或F407。理由很充分它拥有Cortex-M4内核带硬件浮点运算单元FPU这对于需要大量矩阵运算的姿态解算和PID控制来说是巨大的性能提升主频高达168MHz足以应对多传感器数据融合和实时控制任务外设丰富拥有多个SPI、I2C、UART接口方便连接各类传感器生态成熟有HAL库和标准库开发调试工具链完善。控制层这是算法的落脚点。主要运行两个核心算法姿态解算算法将MPU6050的原始数据融合磁力计数据解算成可靠的欧拉角俯仰、横滚、偏航。我们采用了Mahony互补滤波或卡尔曼滤波。Mahony算法参数直观在MCU上实现简单资源消耗小对于电赛级别的精度要求完全足够。卡尔曼滤波更优但更复杂。PID控制算法这是让飞机“听话”的大脑。我们采用了串级PID控制结构。内环角速度环负责快速响应抑制扰动外环角度环负责精准定位。油门单独用一个PID控制器进行高度控制。执行层将控制量转化为实际的动力。电调ESC我们选用支持PWM信号输入或更优的DShot协议的电调。DShot是数字协议比传统的PWM响应更快、分辨率更高、抗干扰更好。电机与桨叶根据飞机轴距和重量我们选择了2205或2306尺寸的无刷电机搭配5045或6040的三叶桨。电机KV值的选择需要与电池电压和桨叶匹配以确保有足够的推力裕度推重比最好大于2:1。机架与电源采用碳纤维机架保证强度与轻量化。电源使用3S或4S锂聚合物电池并搭配电源管理模块PDB为整个系统提供稳定的5V和12V电压。注意总体设计阶段必须考虑重量预算每一个模块、每一根线缆的重量都要估算。超重是性能的第一杀手。我们的原则是在满足功能和可靠性的前提下选用最轻的组件。3. 硬件系统搭建与核心模块解析3.1 飞控核心板设计与传感器集成飞控板是飞行器的大脑我们选择了自制核心板而非直接购买成品飞控这既能深度定制也是电赛考核的重要能力。主控电路围绕STM32F407设计最小系统包括晶振、复位电路、Boot模式选择电路和调试接口SWD。电源部分使用AMS1117-3.3和MP2359等芯片将电池电压逐步降压至5V和3.3V并为模拟传感器部分设计了LC滤波电路最大限度减少电源噪声对传感器读数的影响。传感器电路布局MPU6050通过I2C接口连接。其AD0引脚的电平决定了I2C设备地址这在多个I2C设备共存时需要注意。我们将其单独放在一块小板上通过排针与主控板连接并尽量远离电机和电源线以减少振动和电磁干扰。HMC5883L同样通过I2C连接。磁力计对电磁环境极其敏感必须远离所有大电流线路特别是电池线、电机线。我们最终将其布置在机臂的末端这是整机磁场干扰相对较小的位置。MS5611气压计使用I2C或SPI。关键是要用海绵或软性泡棉将其包裹起来隔离气流扰动导致的压力骤变否则高度数据会跳变剧烈。我们将其放在飞控板的中心位置并开了个小孔让静态空气可以缓慢流通。超声波模块朝向地面安装。需要注意的是超声波在近地面30cm时可能会因地面材质如光滑的赛台产生多次反射导致测距不准。我们为其编写了简单的数据滤波算法如滑动平均。通信接口预留了多个UART分别用于连接数传电台与地面站通信、视觉模块如OpenMV以及GPS模块如果赛题需要。SPI接口则用于连接SD卡存储飞行数据日志用于后期分析和无线模块的某些型号。3.2 动力系统选型与供电设计动力系统直接决定飞行器的“力气”和“耐力”。电机、电调与桨的匹配这是一个迭代过程。我们先估算整机重量包括所有硬件和电池假设为800克。对于四旋翼所需总推力至少应为重量的1.5倍悬停到2倍以上机动即至少需要1200克推力单个电机需提供300克以上推力。查阅电机厂商提供的推力数据表在3S电压11.1V下一款2306 2400KV电机搭配6040三叶桨可能能提供约400克推力四台合计1600克推重比达到2:1满足要求。电调选择与之电流匹配的通常留有余量例如电机最大电流20A则选用30A电调。电池与电源管理电池选择容量mAh决定续航放电倍率C数决定爆发力。我们选用3S 2200mAh 45C的电池。续航粗略估算假设整机悬停电流为15A则理论续航时间为2.2Ah / 15A * 60分钟 ≈ 8.8分钟扣除起降和安全余量实际有效任务时间约5-6分钟这对电赛任务通常是足够的。PDB分电板设计自制PDB不仅分配电力更是安全关键。我们确保电池输入端有XT60接口并并联一个大容量如470μF 35V的电解电容来吸收电调工作时产生的瞬间大电流脉冲防止电压骤降导致飞控重启。每个电调的输出焊盘都做了敷铜加粗处理。同时PDB上集成了5V和3.3V的BEC稳压输出为飞控和传感器供电。机架与装配选用轻量化的碳纤维机架。装配时所有螺丝都使用螺丝胶低强度防止飞行振动导致松动。电机安装必须确保水平任何微小的倾角都会在控制上引入常值偏差。我们使用水平仪仔细校准。线缆用扎带和热缩管固定避免与桨叶干涉。实操心得在焊接电调与PDB、电机与电调的连接时务必先做好绝缘热缩管并且逐个焊接焊完一个立即套上热缩管吹紧再进行下一个。绝对不要把所有线都焊好了再一起处理绝缘极易发生短路烧毁电调或PDB这是我们用一块冒烟的PDB换来的教训。4. 软件算法实现与飞控程序编写4.1 传感器数据读取与滤波处理原始传感器数据噪声很大必须经过处理才能使用。驱动程序编写为每个传感器编写基于STM32 HAL库的I2C/SPI读写驱动程序。关键点在于处理通信超时和校验。例如MPU6050上电后需要等待一段时间约100ms才能稳定读取数据读取时先读其“WHO_AM_I”寄存器进行设备校验。数据预处理校准这是最重要的一步。加速度计和陀螺仪需要做六面校准采集每个轴正反方向的静态数据计算零偏和比例因子。磁力计需要做八字校准以消除硬铁和软铁干扰。校准数据应存储在Flash中上电后加载。低通滤波对于加速度计数据我们使用一阶低通滤波来抑制高频振动噪声。公式简单filtered_data a * raw_data (1-a) * last_filtered_data其中a是滤波系数0 a 1取值小则平滑但延迟大。滑动平均对于超声波等更新较慢、偶尔跳变的数据采用滑动平均滤波保留最近N次采样值求平均。// 示例一阶低通滤波的简单实现 float low_pass_filter(float new_value, float old_value, float alpha) { return alpha * new_value (1 - alpha) * old_value; } // 在姿态解算循环中调用 accel_filtered_x low_pass_filter(accel_raw_x, accel_filtered_x, 0.2f);4.2 姿态解算从数据到角度我们选择了资源消耗和效果平衡较好的Mahony互补滤波算法。其核心思想是利用陀螺仪积分得到角度动态响应好但会漂移利用加速度计和磁力计观测得到角度静态准确但动态噪声大通过一个PI控制器将两者的误差融合起来修正陀螺仪的漂移。初始化上电后飞机需静止放置数秒利用此时的加速度计数据理论上应为[0, 0, g]和磁力计数据初始化四元数。主循环读取陀螺仪角速度弧度/秒。利用当前四元数将加速度计和磁力计的测量向量从机体坐标系转换到地球坐标系。计算转换后的加速度计向量与理论重力向量[0,0,1]的误差叉乘同样计算磁力计向量与理论地磁向量的误差。将这两个误差加权后通过一个PI控制器生成对陀螺仪读数的修正量。用修正后的角速度进行四元数更新积分。最后将四元数转换为欧拉角俯仰、横滚、偏航供PID控制器使用。// Mahony算法核心步骤伪代码 void MahonyAHRSupdate(float gx, float gy, float gz, float ax, float ay, float az, float mx, float my, float mz) { // 1. 归一化加速度计和磁力计数据 // 2. 计算误差叉积 // 3. 积分误差到陀螺仪偏差修正 exInt Ki * ex * dt; // 4. 应用修正 gx Kp * ex exInt; // 5. 四元数更新一阶龙格库塔法 q0 0.5f * dt * (-q1*gx - q2*gy - q3*gz); // ... 更新q1, q2, q3 // 6. 四元数归一化 }注意事项Mahony算法中的两个关键参数Kp和Ki需要调试。Kp决定了对传感器观测值的信任程度太大飞机会“僵硬”响应慢太小则容易漂移。Ki用于消除静态误差通常设为一个很小的值。我们的经验是从Kp2.0, Ki0.001开始调。4.3 串级PID控制器设计与调参串级PID是飞行控制的核心我们以内环为角速度环外环为角度环为例。角度环外环输入期望角度来自遥控器或自主导航与当前估计角度的误差。输出期望的角速度。作用让飞机达到并保持某个姿态。P参数起主要作用I参数消除静差如因电机安装不平或机架不对称导致的微小常值偏差D参数通常较小用于抑制超调。角速度环内环输入角度环输出的期望角速度与当前陀螺仪测量的角速度的误差。输出直接作用于四个电机的PWM控制量或力矩。作用快速响应抵抗外界扰动如一阵风。这个环需要更高的控制频率我们通常用500HzP和D参数是关键I参数可以很小甚至为0。调参步骤与口诀先内环后外环必须先把内环角速度环调稳定飞机才有调外环的基础。先比例P后微分D再积分I将I和D设为0逐渐增大P直到飞机出现高频振荡“抖”然后将P回调到振荡消失的70%-80%。加微分D逐渐增加D能有效抑制振荡让飞机反应更“跟手”。但D过大会引入高频噪声可能引发电机发热。最后加积分I外环的I用于消除角度静差内环的I通常不需要。I值要非常小慢慢增加观察飞机能否在干扰后准确回到原点。口诀“P是基础决定响应速度D是镇定抑制振荡I是修正消除余差”。调试现场记录我们将PID参数存储在Flash中并通过数传电台实时发送到上位机如匿名地面站进行波形显示。在调试时用手轻轻拨动飞机观察角度和角速度的响应曲线。理想的曲线应该是快速上升、超调小、平稳收敛。我们曾因D值过大导致电机产生刺耳的高频噪音同时电机异常发热这就是典型的“D过敏”现象。5. 任务功能实现与系统集成5.1 基于视觉的自主导航实现我们的赛题要求识别地面色块进行循迹。我们选用OpenMV Cam因为它内置了色块识别算法开发简单。视觉处理流程图像采集与预处理OpenMV设置合适的分辨率和帧率如QQVGA 160x120 30fps进行镜头校正消除畸变。色块识别利用find_blobs函数根据HSV颜色阈值寻找目标色块。关键是要在现场光照条件下重新标定HSV阈值实验室的光照和赛场往往差异巨大。位置信息提取获取色块的中心点像素坐标(cx, cy)和像素面积(pixel_area)。坐标转换将像素坐标转换为飞机机体坐标系下的位置偏差。我们采用简单的比例映射假设摄像头视野范围对应实际物理距离则横向偏差error_x (cx - image_width/2) * scale_factor。高度信息则通过色块面积进行粗略估计面积大则离得近。控制融合视觉解算出的error_x和error_y作为新的期望位置输入到位置PID控制器中。位置PID的输出作为角度环的期望角度从而形成“位置-角度-角速度”的三级串级控制。为了防止视觉数据丢失如色块短暂离开视野导致控制失效我们加入了数据有效性判断和失效保持逻辑。当连续N帧未找到色块时切换为保持上一时刻的有效指令或进入悬停模式。# OpenMV 端简化代码示例 import sensor, image, time sensor.reset() sensor.set_pixformat(sensor.RGB565) sensor.set_framesize(sensor.QQVGA) sensor.skip_frames(time 2000) uart UART(3, 115200) # 与飞控通信 while(True): img sensor.snapshot() blobs img.find_blobs([red_threshold]) # 红色色块 if blobs: max_blob max(blobs, keylambda b: b.pixels()) cx max_blob.cx() cy max_blob.cy() # 计算偏差并发送给飞控 error_x cx - 80 # 图像中心x80 error_y cy - 60 # 图像中心y60 uart.write(%d,%d\n % (error_x, error_y)) else: uart.write(lost\n) # 发送丢失信号5.2 无线通信与地面站监控我们使用NRF24L01PALNA无线模块或Si24R1等增强型2.4G模块进行双向通信。通信协议设计自定义一个轻量级的帧结构包含帧头、数据长度、命令字、数据载荷和校验和如CRC8。数据载荷打包飞控的姿态、传感器原始数据、PID参数等下传数据包则包含遥控指令、参数修改命令等。地面站软件使用匿名地面站、QT自行编写或利用现成的软件。核心功能是数据可视化波形显示姿态角、高度、电机输出等曲线这是调参的眼睛。参数在线调试能实时修改PID参数并立即生效无需重新烧录程序极大提升调试效率。虚拟仪表盘显示飞机状态如电池电压、信号强度等。遥控器解码使用一个独立的接收机如PPM接收机或另一路无线通信解析来自遥控器的信号生成期望的姿态和油门指令。我们实现了失控保护功能当超过一定时间未收到遥控信号时飞机自动进入缓慢降落或定点悬停模式。6. 系统调试、问题排查与竞赛心得6.1 飞行测试流程与安全规范调试必须遵循从易到难、从安全到风险的流程。实验室台架测试用绳子或测试架将飞机悬空固定。首先测试遥控器通道映射是否正确电机转向是否正确对角线电机转向相同相邻电机转向相反。然后解锁电机缓慢推油门观察电机是否平稳加速有无异响。系留悬停测试在开阔、柔软的场地如草坪用一根长绳将飞机轻系在地面桩上。进行低空离地20-30厘米悬停测试。重点观察解锁后是否自旋如果自旋说明偏航角速度环的P值需要调整或者电机转向/桨叶装反。是否向一个方向漂移如果漂移可能是加速度计未校准好或者机架不水平。微调遥控器微调或软件角度偏移进行补偿。悬停是否稳定调整角度环PID。自由飞行测试在系留测试稳定后进行短时间、低高度的自由飞行。先练习手动模式下的起降和简单机动再尝试自稳模式最后测试自主任务模式。安全第一任何时候测试桨叶必须安装牢固周围不能有人。电池充电必须在安全箱内进行。飞行时操作者与飞机保持安全距离并随时准备切到手动模式或紧急断电。6.2 典型问题排查速查表问题现象可能原因排查步骤与解决方案上电后飞控无反应1. 电源接反或电压不对。2. Boot引脚配置错误未进入用户程序。3. 晶振不起振。1. 检查电源电压和极性用万用表测量3.3V和5V点。2. 检查BOOT0和BOOT1引脚电平确保为运行模式通常都接地。3. 更换晶振或检查负载电容。MPU6050读不出数据1. I2C地址错误。2. 电源噪声大。3. 上电初始化时序不对。1. 检查AD0引脚电平用逻辑分析仪抓取I2C波形。2. 在电源引脚加滤波电容。3. 上电后延时100ms再进行首次读取。飞机解锁后剧烈抖动或“跳舞”1. 电机排序或转向错误。2. 陀螺仪数据极性错误正负号反了。3. PID参数尤其是角速度环的P值过大。1. 重新检查电机顺序1-4号和转向。2. 检查MPU6050的安装方向在软件中修正坐标系。3. 大幅降低内环P值重新从很小值开始调。飞机自旋偏航不稳定1. 偏航角速度环PID未调好。2. 电机推力不平衡个别电机或电调有问题。3. 机架不对称或重心不在中心。1. 单独调试偏航角速度环确保能快速抑制手动旋转。2. 用电机测试仪检查每个电机在相同油门下的推力是否一致。3. 调整电池或设备位置使重心居中。悬停时高度上下波动“呼吸”高度环PID参数不佳通常是P太大或D太小。降低高度环的P值适当增加D值。检查气压计数据是否平稳加海绵隔离气流。视觉循迹时飞机晃动严重1. 视觉处理延迟过大。2. 位置环PID参数过于激进。3. 图像识别不稳定坐标跳动。1. 降低图像分辨率或优化算法减少处理时间。2. 降低位置环的P值增加一些阻尼D值。3. 对识别到的坐标进行低通滤波。飞行几分钟后突然失控1. 电池电量耗尽电压过低导致电调或飞控重启。2. 无线信号受到干扰。3. 电机或电调过热保护。1. 设置电池低压报警并在软件中监测电压低于阈值自动降落。2. 更换通信频道或使用频率跳频模块。3. 确保电机和电调散热良好检查桨叶是否碰伤导致不平衡。6.3 竞赛现场应对策略环境适应赛场光线、磁场、地面材质都可能与实验室不同。预留至少1小时进行现场校准和参数微调。重新校准加速度计、磁力计重新标定视觉识别的颜色阈值。冗余设计准备备用机、备用核心模块如飞控板、传感器。关键连接点如电池插头使用防松脱接口。流程化操作制定标准的起飞前检查清单如电池电压、遥控器信号、传感器状态、螺旋桨紧固并由非操作队员逐项核对避免因紧张导致的低级失误。心态管理出现问题时按部就班地排查从最可能的电源、连接线开始。如果一次飞行失败不要急于下一次冷静分析数据日志如果记录了的话或现场现象。从电路板上的第一个焊点到飞行器平稳完成赛道任务整个电赛项目是一次浓缩的、高强度的产品开发演练。它教会你的远不止PID调参和画电路图更是如何将理论转化为实践如何在资源、时间受限的压力下进行工程决策以及如何与队友高效协作。最大的收获往往来自于解决那些未曾预料到的问题比如深夜调试时发现的一个硬件虚焊或是算法中一个正负号的错误。这些经历比任何奖状都更为珍贵。
![[光学原理与应用-521]：对光的错误理解与纠偏](http://pic.xiahunao.cn/yaotu/[光学原理与应用-521]：对光的错误理解与纠偏)
