四旋翼无人机位姿控制系统设计优化
作者信息
学校:武汉纺织大学
团队成员:廖启俊、柳超、高紫娟
指导教师:张国琴
一、案例概述
本案例来源于第十五届“中国软件杯”大学生软件设计大赛A8赛题,完整实现四旋翼无人机位姿控制系统设计优化仿真方案。依托MWORKS.Sysplorer多领域统一建模能力,搭建包含机体动力学、电机电驱执行机构、传感器、地面接触模型的完整四旋翼物理仿真对象。
案例采用标准化统一接口设计,实现多款位姿控制器即插即用切换,包含基准串级PID、LQG线性二次高斯控制、滑模SMC、反步Backstepping、积分反步滑模IBS+SMC;轨迹生成模块支持6种单机运动轨迹,同时扩展三机编队协同能力,覆盖领航‑跟随、一致性编队、队形变换等多类编队场景。
仿真可在标称工况、机体质量/升力系数参数摄动、风扰+位置测量噪声三类工况下运行,输出轨迹RMSE、最大误差、稳态误差、IAE、执行器峰值、鲁棒性能保持度等量化指标,完成不同控制算法的跟踪精度、动态响应、抗扰动能力横向对比。本案例既可用于竞赛复现,也可作为《自动控制原理》《飞行器控制》《智能无人机系统》课程综合实训、课程设计教学案例。
二、核心技术与知识点
-
四旋翼多领域物理建模
完整四旋翼动力学模型;永磁直流电机+逆变器电驱执行机构闭环模型;传感器测量模块;非线性弹簧‑阻尼地面接触模型,模拟起飞、降落接触冲击;执行器限幅、电机动态滞后等工程真实特性。 -
五类位姿控制器原理
- 串级PID:位置外环‑姿态内环‑电机混控三级架构,带积分抗饱和、输出限幅,作为基准对比控制器;
- SMC滑模控制:构造滑模面,等效控制+趋近律,饱和函数抑制抖振,适配模型不确定性与外部扰动;
- LQG控制:工作点线性化,Kalman滤波状态估计,LQR求解Riccati方程得到最优反馈增益,兼顾跟踪精度、估计误差与控制能耗;
- Backstepping反步控制:位置‑姿态‑执行器级联递推,逐层构造虚拟控制量,处理系统耦合非线性;
- IBS+SMC积分反步滑模:融合积分反步与积分滑模,增加积分项消除持续扰动带来稳态偏差,饱和函数削弱滑模抖振,增加积分抗饱和保护。
-
轨迹生成模块
单机轨迹:阶梯爬升、螺旋爬升、八字轨迹、正弦轨迹、圆弧轨迹、爱心轨迹;
编队轨迹:直线‑三角队形变换、领航‑跟随螺旋巡航、一致性八字编队、爱心编队、正弦巡航、圆形环绕三机编队。 -
仿真评价指标体系
- 时域指标:超调量、调节时间、高度稳态误差、最大绝对误差、绝对误差积分IAE;
- 轨迹精度:轨迹RMSE,编队相对位置误差;
- 执行器特性:四路电机指令峰值u_peak;
- 鲁棒性指标:性能保持度η(摄动/扰动工况RMSE与标称工况RMSE比值,越接近1鲁棒性越好)。
三、运行环境
- 仿真平台:MWORKS.Sysplorer 2026b
- 后处理脚本:MWORKS.Syslab Julia环境
- 模型依赖:Sysplorer标准多体库、电气库、信号库,无额外第三方商业库。
仿真说明:模型内置控制器选择开关、轨迹选择开关,直接修改参数即可快速切换控制器与轨迹,无需手动重新连接模型;仿真输出时序数据导出csv,交由Syslab Julia脚本完成指标计算与绘图。
四、使用操作说明
- 在Sysplorer打开顶层
package.mo,加载完整模型包; - 打开顶层仿真总模型,通过参数面板完成配置:
- 选择控制器:PID / LQG / SMC / Backstepping / IBS+SMC;
- 选择单机轨迹或者开启三机编队模式;
- 设置仿真工况:【标称工况】 / 【参数摄动:升力±20%、质量+10%】 / 【风扰+位置测量噪声】;
- 设置仿真时长,运行仿真,模型自动输出时序数据并导出csv文件;
- 将导出数据导入Syslab,运行
metric_calc.jl与plot_result.jl,自动计算各项评价指标,生成误差曲线、三维轨迹图、鲁棒性柱状对比图; - 教学研究拓展:可修改控制器参数、轨迹参数、扰动强度,对比不同条件下算法性能。
典型仿真测试场景
- 单机基础测试
- 阶梯爬升:观察高度通道超调、调节时间、稳态误差;
- 螺旋爬升:测试高度持续爬升+平面周期运动协同能力;
- 八字轨迹:测试连续换向、横纵向耦合条件下轨迹跟踪能力。
- 鲁棒性测试
- 参数摄动:升力系数±20%、机体质量+10%,计算性能保持度η;
- 风扰+位置测量噪声:叠加阶跃/正弦湍流风扰动与传感器高斯噪声,评估抗干扰能力。
- 编队仿真测试
三机编队:队形变换、领航跟随螺旋巡航、一致性八字编队、爱心、正弦巡航、圆形环绕,观察队形保持与相对位置误差。
本案例版权归属武汉纺织大学扶摇揽云队,仅供非商业教学学习,请勿直接用于各类赛事及项目等内容的申报。