5.12 飞行控制——PID参数优化

2024-09-02 15:28

本文主要是介绍5.12 飞行控制——PID参数优化,希望对大家解决编程问题提供一定的参考价值,需要的开发者们随着小编来一起学习吧!

文章目录

    • 5.12 飞行控制——PID参数优化
      • 5.12.1 XY轴角度系统P参数优化
        • (1)软件设计
        • (2)运行与调试
      • 5.12.2 Z轴角度系统P参数优化
      • 5.12.3 Z轴位置系统P参数优化
      • 5.12.4 XY轴位置系统P参数优化

总目录:http://t.csdnimg.cn/YDe8m

5.12 飞行控制——PID参数优化

  在“5.9.8”小节提到过,使用Matlab自带的优化求解函数“lsqnonlin”函数,可以进行PID控制器参数的优化。但由于方法较为“粗暴”,当求解参数过多、系统过于复杂、离散时间数过大时常会出现死机、求解出错等问题。一个解决的方法就是分步进行PID参数的优化,并且只对P参数进行优化,其它参数设置为0,保证每次只对2~3个参数进行优化。
  本小节共有四个例程,依次对XY轴角度系统P参数、Z轴角度系统P参数、Z轴位置系统P参数、XY轴位置系统P参数进行了优化,最后得到了完整可用的四旋翼串级PID控制器的控制参数。

5.12.1 XY轴角度系统P参数优化

  首先对XY轴角度环PID、角速度环PID的P参数进行优化,由于XY轴参数经常是相同的,故最终只优化两个参数即可。

(1)软件设计

   本小节例程位于“2、飞控例程\Matlab\(5)飞行控制——PID参数优化\A1_XY轴角度系统系统P参数优化”中。
   例程中的文件如图5.11.2所示,主要增加了“A3_aXY_Angle_better_main.mlx”、“A3_aXY_Angle_better_run.m”、“A3_aXY_Angle_plot.m”等文件。

A3_aXY_Angle_better_main.mlx 文件

clear all;
close all;
clc;%% X、Y轴角度系统 P参数优化
K_pid0=[1 100];LB=[0 0];       %x、y轴角度环、角速度环PID P参数
UB=[10 1500];K_pid=lsqnonlin('A3_aXY_Angle_better_run',K_pid0,LB,UB);%输出优化后PID参数到Excel
K_pid = K_pid * 0.8;        %缩小到80%,防止震荡init = 0;
A2_init;
s_pid.K_pid(1:4, 1:3) = zeros(4, 3);
s_pid.K_pid(1:2, 1) =  K_pid'; 
s_pid.K_pid(3:4, 1) =  K_pid'; data_o = round(s_pid.K_pid, 3);   %四舍五入为3位小数
xlswrite('输出_PID参数.xlsx', data_o, 1, 'C2:E7');%% 使用优化后的PID参数 仿真并绘图
A3_aXY_Angle_plot(K_pid);         %优化PID参数 仿真并绘图
  • 行7~10
    设置角度环、角速度环PID中P参数的初值、下限、上限。
  • 行12
    运行优化函数,得到最优的P参数,保存在“K_pid”变量中
  • 行14
    为了适应之后位置环PID、线速度环PID的控制,这里对优化后参数进行80%的缩小。
  • 行17~21
    初始化系统,主要是使用“A2_init”读取“输入_系统参数.xlsx”文件中角度系统相关PID参数,其后将优化后的P参数保存在“s_pid.K_pid”变量对应位置。
  • 行23~24
    将优化后的PID参数四舍五入为3位小数,并保存到“输出_PID参数.xlsx”文件中,保存的位置如图5.12.1所示:

在这里插入图片描述

图 5.12.1

  • 行27
    调用“A3_aXY_Angle_plot”函数,使用优化后的参数进行四旋翼系统仿真,并绘制曲线图。

A3_aXY_Angle_better_run.m 文件
  该文件以“A1_main.mlx”文件为基础进行修改,只是在开关与结尾增加了一些内容。该函数的输入,为要优化的P参数,输出为第时刻X、Y轴角速度、角度期望与测量的误差。

function [Run_e] = A3_Pid_better_run(K_pid)
% PID控制系统运行函数% 输入:
%   K_pid   使用的PID的参数
%
% 输出
%   Run_e   各时刻 期望与系统输出的误差%% 初始化系统参数
init = 0;
A2_init;
s_pid.K_pid(1:4, 1:3) = zeros(4, 3);
s_pid.K_pid(1:2, 1) =  K_pid'; 
s_pid.K_pid(3:4, 1) =  K_pid'; %% 仿真
init = 1;   %已初始化完毕
for i = 1:(Num)% 串级PID控制C_Cascade_PID;% 动态系统响应M_Motor;    %电机s_A.u = s_mot.M_xyz;          %赋值角度系统输入M_Angle;                  %四旋翼角度系统s_P.u(1:3, 1) = s_mot.F_xyz;  %赋值位置系统输入s_P.u(4, 1) = s_P.g;M_Position;               %四旋翼位置系统%保存电机模型输入输出数据s_History.u_all(i, :) = s_mot.u_all';s_History.F_xyz(i, :) = s_mot.F_xyz';s_History.M_xyz(i, :) = s_mot.M_xyz';%保存角度系统输出数据s_History.ya(i, :) = s_A.y.*180/pi;  %角度,单位(deg) %保存位置系统输出数据s_History.yp(i, :) = s_P.y;  %位置,单位(m) 
end%% 函数输出
Ax_e = abs(s_pid.d(1)*180/pi - s_History.ya(:, 1)); 
Wx_e = abs(s_pid.d(2)*180/pi - s_History.ya(:, 2)); 
Ay_e = abs(s_pid.d(3)*180/pi - s_History.ya(:, 3)); 
Wy_e = abs(s_pid.d(4)*180/pi - s_History.ya(:, 4)); Run_e = [Ax_e 0.1*Wx_e Ay_e 0.1*Wy_e];end
  • 行11~15
    初始化系统,并将XY角度环、角速度环PID参数归零,之后再将其P值赋值为函数的输入。
  • 行17~43
    系统仿真,与“A1_main.mlx”相同。
  • 行46~52
    函数输出XY各时刻角度与角速度的误差,优化的过程就是不断尝试新的P参数以使输出的误差最小。

A3_aXY_Angle_plot.m 文件
  该函数也修改自“A1_main.mlx”文件。只是仿真时使用的是优化后的P参数。

function [] = A3_aXY_Angle_plot(K_pid)
% PID控制系统运行函数% 输入:
%   K_pid   使用的PID的参数
%
%% 初始化系统参数
init = 0;
A2_init;s_pid.K_pid(1:4, 1:3) = zeros(4, 3);
s_pid.K_pid(1:2, 1) =  K_pid'; 
s_pid.K_pid(3:4, 1) =  K_pid'; %% 仿真
init = 1;   %已初始化完毕
for i = 1:(Num)% 串级PID控制C_Cascade_PID;% 动态系统响应M_Motor;    %电机s_A.u = s_mot.M_xyz;          %赋值角度系统输入M_Angle;                  %四旋翼角度系统s_P.u(1:3, 1) = s_mot.F_xyz;  %赋值位置系统输入s_P.u(4, 1) = s_P.g;M_Position;               %四旋翼位置系统%保存电机模型输入输出数据s_History.u_all(i, :) = s_mot.u_all';s_History.F_xyz(i, :) = s_mot.F_xyz';s_History.M_xyz(i, :) = s_mot.M_xyz';%保存角度系统输出数据s_History.ya(i, :) = s_A.y.*180/pi;  %角度,单位(deg) %保存位置系统输出数据s_History.yp(i, :) = s_P.y;  %位置,单位(m) 
end%% 函数输出% 绘图
P_plot_all;end
  • 行8~13
    初始化系统,并将XY角度环、角速度环PID参数归零,之后再将其P值赋值为函数的输入。
(2)运行与调试

   双击进入“A3_aXY_Angle_better_main”文件,点击上方“实时编辑器”中的“运行”按钮即可运行例程。运行结果如图5.11.3所示。
在这里插入图片描述

(a)
在这里插入图片描述

(b)
在这里插入图片描述

(c)

图 5.12.2

  同时优化后的PID参数保存在“输出_PID参数.xlsx”文件中。将优化后的PID参数复制到“输入_系统参数.xlsx”文件对应位置,即可使用“A1_main.mxl”文件进行仿真。

5.12.2 Z轴角度系统P参数优化

   其原理与5.12.1小节相似,只是将优化的参数换为了z轴角度系统串级PID的P参数。
   本小节例程位于“2、飞控例程\Matlab\(5)飞行控制——PID参数优化\A2_Z轴角度系统系统P参数优化”中。
   主要增加了“A3_bZ_Angle_better_main.mlx”、“A3_bZ_Angle_better_run.m”、“A3_bZ_Angle_plot.m”等文件,其具体原理不同赘述。
   双击进入“A3_bZ_Angle_better_main.mlx”文件,点击上方“实时编辑器”中的“运行”按钮即可运行例程。运行结果如图5.11.3所示。
在这里插入图片描述

(a)
在这里插入图片描述

(b)
在这里插入图片描述

(c)

图 5.12.3

  然后,将优化后的PID参数从“输出_PID参数.xlsx”文件,复制到“输入_系统参数.xlsx”文件对应位置进行保存。

5.12.3 Z轴位置系统P参数优化

   本小节例程位于“2、飞控例程\Matlab\(5)飞行控制——PID参数优化\A3_Z轴位置系统系统P参数优化”中。功能是优化z轴位置系统串级PID的P参数
   主要增加了“A3_cZ_Position_better_main.mlx”、“A3_cZ_Position_better_run.m”、“A3_cZ_Position_plot.m”等文件,其具体原理不同赘述。
   双击进入“A3_cZ_Position_better_main.mlx”文件,点击上方“实时编辑器”中的“运行”按钮即可运行例程。运行结果如图5.11.4所示。
在这里插入图片描述

(a)
在这里插入图片描述

(b)
在这里插入图片描述

(c)

图 5.12.4

  然后,将优化后的PID参数从“输出_PID参数.xlsx”文件,复制到“输入_系统参数.xlsx”文件对应位置进行保存。

5.12.4 XY轴位置系统P参数优化

   本小节例程位于“2、飞控例程\Matlab\(5)飞行控制——PID参数优化\A4_XY轴位置系统系统P参数优化”中。功能是优化z轴位置系统串级PID的P参数
   主要增加了“A3_dXY_Position_better_main.mlx”、“A3_dXY_Position_better_run.m”、“A3_dXY_Position_plot.m”等文件,其具体原理不同赘述。
   双击进入“A3_dXY_Position_better_main.mlx”文件,点击上方“实时编辑器”中的“运行”按钮即可运行例程。运行结果如图5.11.5所示。
在这里插入图片描述

(a)
在这里插入图片描述

(b)
在这里插入图片描述

(c)

图 5.12.5

  然后,将优化后的PID参数从“输出_PID参数.xlsx”文件,复制到“输入_系统参数.xlsx”文件对应位置进行保存。至此所有串级PID的参数全部优化完毕。

这篇关于5.12 飞行控制——PID参数优化的文章就介绍到这儿,希望我们推荐的文章对编程师们有所帮助!


原文地址:
本文来自互联网用户投稿,该文观点仅代表作者本人,不代表本站立场。本站仅提供信息存储空间服务,不拥有所有权,不承担相关法律责任。如若转载,请注明出处:http://www.chinasem.cn/article/1130337

相关文章

Java内存分配与JVM参数详解(推荐)

《Java内存分配与JVM参数详解(推荐)》本文详解JVM内存结构与参数调整,涵盖堆分代、元空间、GC选择及优化策略,帮助开发者提升性能、避免内存泄漏,本文给大家介绍Java内存分配与JVM参数详解,... 目录引言JVM内存结构JVM参数概述堆内存分配年轻代与老年代调整堆内存大小调整年轻代与老年代比例元空

MyBatisPlus如何优化千万级数据的CRUD

《MyBatisPlus如何优化千万级数据的CRUD》最近负责的一个项目,数据库表量级破千万,每次执行CRUD都像走钢丝,稍有不慎就引起数据库报警,本文就结合这个项目的实战经验,聊聊MyBatisPl... 目录背景一、MyBATis Plus 简介二、千万级数据的挑战三、优化 CRUD 的关键策略1. 查

Spring如何使用注解@DependsOn控制Bean加载顺序

《Spring如何使用注解@DependsOn控制Bean加载顺序》:本文主要介绍Spring如何使用注解@DependsOn控制Bean加载顺序,具有很好的参考价值,希望对大家有所帮助,如有错误... 目录1.javascript 前言2. 代码实现总结1. 前言默认情况下,Spring加载Bean的顺

基于Python开发Windows屏幕控制工具

《基于Python开发Windows屏幕控制工具》在数字化办公时代,屏幕管理已成为提升工作效率和保护眼睛健康的重要环节,本文将分享一个基于Python和PySide6开发的Windows屏幕控制工具,... 目录概述功能亮点界面展示实现步骤详解1. 环境准备2. 亮度控制模块3. 息屏功能实现4. 息屏时间

Python远程控制MySQL的完整指南

《Python远程控制MySQL的完整指南》MySQL是最流行的关系型数据库之一,Python通过多种方式可以与MySQL进行交互,下面小编就为大家详细介绍一下Python操作MySQL的常用方法和最... 目录1. 准备工作2. 连接mysql数据库使用mysql-connector使用PyMySQL3.

如何搭建并配置HTTPD文件服务及访问权限控制

《如何搭建并配置HTTPD文件服务及访问权限控制》:本文主要介绍如何搭建并配置HTTPD文件服务及访问权限控制的问题,具有很好的参考价值,希望对大家有所帮助,如有错误或未考虑完全的地方,望不吝赐教... 目录一、安装HTTPD服务二、HTTPD服务目录结构三、配置修改四、服务启动五、基于用户访问权限控制六、

一文详解PostgreSQL复制参数

《一文详解PostgreSQL复制参数》PostgreSQL作为一款功能强大的开源关系型数据库,其复制功能对于构建高可用性系统至关重要,本文给大家详细介绍了PostgreSQL的复制参数,需要的朋友可... 目录一、复制参数基础概念二、核心复制参数深度解析1. max_wal_seChina编程nders:WAL

SpringBoot中HTTP连接池的配置与优化

《SpringBoot中HTTP连接池的配置与优化》这篇文章主要为大家详细介绍了SpringBoot中HTTP连接池的配置与优化的相关知识,文中的示例代码讲解详细,感兴趣的小伙伴可以跟随小编一起学习一... 目录一、HTTP连接池的核心价值二、Spring Boot集成方案方案1:Apache HttpCl

PyTorch高级特性与性能优化方式

《PyTorch高级特性与性能优化方式》:本文主要介绍PyTorch高级特性与性能优化方式,具有很好的参考价值,希望对大家有所帮助,如有错误或未考虑完全的地方,望不吝赐教... 目录一、自动化机制1.自动微分机制2.动态计算图二、性能优化1.内存管理2.GPU加速3.多GPU训练三、分布式训练1.分布式数据

MySQL精准控制Binlog日志数量的三种方案

《MySQL精准控制Binlog日志数量的三种方案》作为数据库管理员,你是否经常为服务器磁盘爆满而抓狂?Binlog就像数据库的“黑匣子”,默默记录着每一次数据变动,但若放任不管,几天内这些日志文件就... 目录 一招修改配置文件:永久生效的控制术1.定位my.cnf文件2.添加核心参数不重启热更新:高手应