简介这份资源面向固定翼无人机飞控开发者与航空院校学生聚焦着陆阶段的纵向控制问题提供从动力学建模到Simulink仿真的完整工程实现。包内共8个文件以4个m脚本、2个mdl与2个slx模型为主压缩包约70KB体积轻便却覆盖了纵向ABCD状态空间建模、着陆路径规划、高度跟踪与PID控制器设计等核心环节。其中脚本文件负责定义无人机下降过程中的速度、高度动态模型并计算安全着陆轨迹Simulink模型则搭建了着陆控制与高度跟踪的图形化系统便于调试与参数整定。已有2069人学习下载适合希望理解PID在着陆纵向通道中应用、并借助仿真验证控制策略的读者参考可据此复现建模流程、分析轨迹规划思路并优化控制器响应性能。1. 固定翼着陆为什么总在最后三米翻车固定翼无人机着陆飞控圈里有个说法叫“最后三米玄学”——巡航段稳如老狗一进拉平就各种飘、跳、砸。做过固定翼着陆纵向控制的人都知道问题不在飞控硬件而在纵向通道的拉平轨迹设计和速度-俯仰耦合没解干净。这套方案要解决的就是固定翼从进场到触地的纵向控制问题下滑道跟踪、拉平轨迹生成、俯仰姿态保持、油门-升降舵协调四个环节串成一条完整的控制链。适合正在做飞控毕设、课程设计或者要交付一套固定翼着陆控制方案的工程师参考。整套方案基于PID框架搭建不依赖复杂非线性控制理论用经典方法把着陆纵向通道做扎实。2. 需求拆解与控制方案选型从进场到触地的纵向通道怎么分2.1 着陆纵向控制到底要控什么固定翼着陆纵向控制的核心任务是在纵向平面内让飞机沿预定下滑道下降在拉平段平滑减小下降率最终以可控的俯仰姿态和垂速触地。拆开来看纵向通道要同时管三件事高度或下滑道偏差、速度通过油门、俯仰姿态通过升降舵。这三者之间存在强耦合——拉杆抬头会减速推油门加速会带来抬头力矩速度变化又反过来影响升力进而影响高度。通常的做法是把纵向通道拆成两个回路外回路管高度/下滑道输出俯仰角指令内回路管俯仰角输出升降舵偏度。速度通道独立走油门控制用速度偏差驱动油门。这样解耦之后每个回路的PID参数可以独立整定不至于一改油门就把俯仰振荡带出来。需求上还要明确几个边界条件进场高度和速度、下滑道角度通常3°到6°、拉平起始高度一般15m到30m、触地垂速上限通常要求小于1.5m/s、触地俯仰角范围。这些参数不提前定好后面PID整定就是盲调。2.2 为什么选PID而不是LQR或MPCPID在这个场景下的优势很直接计算量小、参数物理意义明确、调试过程可解释。LQR需要精确的纵向线性模型而固定翼在低速着陆段的气动参数非线性明显模型误差一大LQR的鲁棒性反而不如PID。MPC更不用说了机载算力根本跑不动。但PID也不是万能的。固定翼着陆纵向通道的PID整定有个血泪经验俯仰角内环的微分项不能给太大否则升降舵高频抖动舵机很快就发热。通常的做法是内环用PD比例微分外环用PI比例积分速度通道用PI。积分项的作用是消除稳态误差但积分限幅一定要做不然拉平段积分饱和触地前会突然掉高度。2.3 控制模式划分与切换逻辑整个着陆过程分四个模式下滑道跟踪、拉平过渡、拉平保持、触地滑跑。下滑道跟踪段外回路跟踪下滑道偏差输出俯仰角指令拉平过渡段从下滑道跟踪平滑切换到拉平轨迹跟踪切换点通常在拉平起始高度拉平保持段跟踪指数拉平轨迹俯仰角指令逐渐减小触地段油门收怠速俯仰角保持小角度抬头。模式切换是着陆纵向控制最容易翻车的地方。切换瞬间如果指令跳变飞机会猛抬头或猛低头。通常的做法是在切换点做指令渐变用一阶滤波器把切换前后的指令平滑过渡时间常数取0.5s到1s。# 模式切换时的指令平滑处理 class CommandSmoother: def __init__(self, tau0.8): self.tau tau # 一阶滤波时间常数单位秒 self.prev_cmd 0.0 # 上一周期平滑后的指令 def update(self, raw_cmd, dt): # 一阶低通滤波避免模式切换时指令跳变 alpha dt / (self.tau dt) smooth_cmd alpha * raw_cmd (1 - alpha) * self.prev_cmd self.prev_cmd smooth_cmd return smooth_cmd这段代码的作用是在模式切换时对俯仰角指令做一阶低通滤波。tau越大过渡越平滑但响应越慢tau越小响应快但可能引入抖动。着陆场景下通常取0.5到1.0秒具体看飞机质量和进场速度。dt是飞控周期固定翼飞控一般跑50Hz到100Hz对应dt为0.02s到0.01s。3. 纵向控制律设计与参数整定外回路、内回路、速度通道3.1 下滑道跟踪外回路设计下滑道跟踪外回路的输入是下滑道偏差实际高度与下滑道高度的差输出是俯仰角指令。控制律用PI# 下滑道跟踪外回路PI控制器 class GlidePathController: def __init__(self, kp0.08, ki0.005, limit15.0): self.kp kp # 比例增益单位度/米 self.ki ki # 积分增益单位度/(米·秒) self.limit limit # 俯仰角指令限幅单位度 self.integral 0.0 def update(self, height_error, dt): # 积分项累加并限幅防止积分饱和 self.integral height_error * dt self.integral max(-self.limit/self.ki, min(self.limit/self.ki, self.integral)) # PI输出俯仰角指令 pitch_cmd self.kp * height_error self.ki * self.integral # 输出限幅避免指令过大导致飞机猛抬头 pitch_cmd max(-self.limit, min(self.limit, pitch_cmd)) return pitch_cmdkp的物理含义是高度偏差1米对应多少度俯仰角指令。这个值不能太大否则下滑道跟踪会振荡也不能太小否则跟踪不上下滑道。通常从0.05开始试逐步加到0.1左右。ki用来消除稳态偏差但给大了会在拉平段积分饱和触地前掉高度。limit一般取10°到15°限制最大俯仰角指令。3.2 俯仰角内回路设计内回路跟踪外回路给出的俯仰角指令输出升降舵偏度。用PD控制# 俯仰角内回路PD控制器 class PitchController: def __init__(self, kp1.2, kd0.15, limit25.0): self.kp kp # 比例增益单位度舵面/度俯仰角 self.kd kd # 微分增益单位度舵面/(度/秒) self.limit limit # 升降舵偏度限幅单位度 self.prev_error 0.0 def update(self, pitch_cmd, pitch_actual, dt): error pitch_cmd - pitch_actual # 微分项用误差差分近似注意dt不能太小否则噪声放大 d_error (error - self.prev_error) / dt self.prev_error error # PD输出升降舵偏度 elevator self.kp * error self.kd * d_error # 舵面限幅保护舵机 elevator max(-self.limit, min(self.limit, elevator)) return elevatorkp决定俯仰角跟踪的刚度给大了会振荡给小了跟踪慢。kd抑制超调但固定翼的俯仰角速率信号通常有噪声kd给大了舵面会抖。通常的做法是对俯仰角速率做低通滤波后再用截止频率取5Hz到10Hz。limit根据舵机行程和飞机气动特性定一般不超过25°。3.3 速度通道油门控制速度通道用PI控制油门输入是速度偏差输出是油门指令# 速度通道PI控制器 class SpeedController: def __init__(self, kp0.5, ki0.08, limit1.0): self.kp kp # 比例增益单位油门/米/秒 self.ki ki # 积分增益 self.limit limit # 油门限幅0到1 self.integral 0.0 def update(self, speed_cmd, speed_actual, dt): error speed_cmd - speed_actual self.integral error * dt # 积分限幅防止油门积分饱和 self.integral max(-self.limit/self.ki, min(self.limit/self.ki, self.integral)) throttle self.kp * error self.ki * self.integral throttle max(0.0, min(self.limit, throttle)) return throttle速度通道的响应不能太快否则油门变化剧烈会影响俯仰通道。kp通常取0.3到0.8ki取0.05到0.1。拉平段速度指令一般比进场速度略小但也不能太小否则失速裕度不够。3.4 拉平轨迹生成与跟踪拉平轨迹通常用指数曲线h(t) h0 * exp(-t/tau)其中h0是拉平起始高度tau是时间常数。拉平起始高度一般取15m到30mtau取2s到4s。拉平轨迹的下降率在触地时趋近于零但实际触地垂速不可能为零通常控制在0.5m/s到1.5m/s。# 指数拉平轨迹生成 import math class FlareTrajectory: def __init__(self, h020.0, tau3.0, h_flare0.5): self.h0 h0 # 拉平起始高度单位米 self.tau tau # 时间常数单位秒 self.h_flare h_flare # 触地判定高度单位米 self.t 0.0 def update(self, dt): self.t dt # 指数拉平轨迹高度随时间指数衰减 h_cmd self.h0 * math.exp(-self.t / self.tau) # 下降率指令对高度求导 h_dot_cmd -(self.h0 / self.tau) * math.exp(-self.t / self.tau) return h_cmd, h_dot_cmdh0和tau的选取直接影响触地垂速。h0越大、tau越小拉平越陡触地垂速越大。通常的做法是先定h0根据飞机下沉特性再调tau让触地垂速落在0.5到1.5m/s之间。拉平轨迹跟踪用高度偏差驱动俯仰角指令和下滑道跟踪共用外回路PI但参数要单独整定。4. 避坑与常见问题排查着陆纵向控制里最容易翻车的五个点4.1 拉平段掉高度积分饱和在作怪现象飞机进入拉平段后高度先跟得很好但触地前突然掉高度垂速超标。原因下滑道跟踪段的积分项在拉平段还在累加拉平段高度偏差符号变化后积分项需要时间退出饱和导致俯仰角指令响应滞后。解决在模式切换到拉平时把外回路积分项清零或限幅到较小值。通常的做法是在拉平过渡段把积分增益暂时降为零等拉平稳定后再恢复。4.2 俯仰振荡微分项噪声放大现象俯仰角跟踪过程中出现高频振荡升降舵持续抖动舵机发热明显。原因俯仰角速率信号噪声大微分项把噪声放大了。固定翼的俯仰角速率通常来自陀螺仪低频振动和传感器噪声都会串进来。解决对俯仰角速率做低通滤波截止频率取5Hz到10Hz。如果还振把微分增益降一半再试。实在不行就只用比例控制牺牲一点动态性能换稳定性。4.3 触地弹跳拉平轨迹太陡或触地判定太早现象飞机触地后弹起来然后再掉下去严重时损坏起落架。原因拉平轨迹下降率在触地时还比较大或者触地判定高度设高了飞机还没真正接地就切了触地模式。解决增大拉平时间常数tau让下降率在触地前充分衰减。触地判定高度通常取0.3m到0.5m结合无线电高度表和加速度计综合判断。触地后油门立即收怠速俯仰角保持小角度抬头不要急着推杆。4.4 速度通道和俯仰通道打架现象速度跟踪和高度跟踪互相干扰推油门加速时飞机抬头拉杆抬头时速度掉得快。原因固定翼的油门和升降舵之间存在气动耦合速度变化会影响升力俯仰变化会影响阻力。两个通道的PID参数如果都整得比较激进就会互相激发振荡。解决速度通道的带宽要明显低于俯仰通道通常速度通道的响应时间常数取俯仰通道的3到5倍。整定时先整俯仰通道再整速度通道最后联调。联调时如果发现耦合振荡先把速度通道的kp降20%再试。4.5 模式切换时指令跳变现象下滑道跟踪切拉平时飞机猛抬头或猛低头乘客如果有会很不舒服。原因两个模式的俯仰角指令在切换瞬间不连续或者切换逻辑里没有做指令平滑。解决在切换点用一阶滤波器做指令渐变时间常数取0.5s到1s。同时确保切换前后的指令值在切换点附近不要差太多。如果差得多说明两个模式的配平点不一致需要先调配平。5. 仿真验证与试飞验收怎么证明这套纵向控制真的能用5.1 仿真环境搭建与测试用例设计仿真验证分三步先做纵向通道的线性模型仿真验证PID参数的基本响应再做非线性六自由度仿真验证模式切换和拉平轨迹最后做蒙特卡洛仿真拉偏初始高度、速度、风干扰看触地垂速和俯仰角的分布。测试用例至少覆盖正常进场着陆、拉平起始高度偏高/偏低、进场速度偏大/偏小、下滑道角度偏大/偏小、触地前有阵风。每个用例跑20次以上统计触地垂速的均值和标准差。触地垂速均值控制在1.0m/s以内标准差不超过0.3m/s基本就稳了。5.2 试飞验收检查单试飞验收按阶段来先做高空下滑道跟踪试飞不拉平验证外回路和内回路的跟踪精度再做拉平段试飞从拉平起始高度开始验证拉平轨迹跟踪和触地垂速最后做全流程着陆试飞。检查单上必须有的项下滑道偏差最大值、俯仰角跟踪误差最大值、触地垂速、触地俯仰角、触地速度、模式切换瞬间的俯仰角跳变量。触地垂速超过1.5m/s就判不合格模式切换俯仰角跳变超过3°也要查原因。验收项合格标准测试方法下滑道偏差小于5m下滑道跟踪试飞俯仰角跟踪误差小于3°全流程试飞触地垂速小于1.5m/s拉平段试飞触地俯仰角5°到12°全流程试飞模式切换跳变小于3°全流程试飞5.3 答辩时怎么讲清楚这套方案答辩讲这套纵向控制重点讲三件事为什么选PID、模式怎么分、参数怎么整。为什么选PID讲计算量和可解释性别扯太多理论。模式怎么分画一张状态机图把四个模式和切换条件标清楚。参数怎么整讲整定顺序和每个参数的作用最好带一张参数表。评委最容易问的问题是拉平段积分饱和怎么处理模式切换跳变怎么抑制触地垂速怎么保证这三个问题前面避坑章节都覆盖了答辩前把这几段背熟。还有评委可能会问为什么不用LQR或MPC回答就一句话机载算力不够PID够用。从那以后我每次做着陆纵向控制都强制走一遍仿真到试飞的完整验证流程不敢跳步。希望帮到你。本文还有配套的精品资源点击获取