倒立摆系统控制策略设计及验证

1、实验要求

1、查阅资料,利用机理建模法推导直线一级倒立摆传递函数和状态空间方程;

2、在MATLAB下判断其能控性、能观性;

3、设计控制器,利用极点配置的方法,使得校正后系统调整时间 <=1s,最大超调量<10 %;

4、MATLAB/Simulink进行系统仿真,验证性能;

2、实验步骤

2.1、系统建模

小车x方向:F-Fx-f=Mx

摆杆X方向:

Fx=md2dt2x-Lsinθ=mddtx-Lcosθθ2=mx+mLsinθθ2-mLcosθθ

摆杆Y方向:

mg-Fy=md2dt2Lcosθ=md2dt2-Lsinθθ2=-mLcosθθ2-mLsinθθ
摆杆力矩平衡:

Iθ=Fx Lcosθ+Fy Lsinθ

由于控制的目的是保持倒立摆直立,此处假设摆杆转角较小,则可以得到如下假设sinθ=θ ,cosθ=1 。

则:

Fx=mx¨+ mLθθ2-mLθ

Fy=mg+ mLθ2+mLθθ

Iθ=Fx L+Fy Lθ

以上方程都是非线性方程,为求得解析解,需做线性化处理,有θ2=0 ;θ=0 ;θ2=0。 设置摩擦力为f=bx 。设置输入控制量为u(即图中F),则系统的平衡控制方程为:

M+mx+bx-mLθ=uI+L2θ-mLx-mgLθ=0

θ=-μmLM+mI+MmL2x+M+mmgLM+mI+MmL2θ+mLM+mI+MmL2u

x=-bI+mL2M+mI+MmL2x+m2gL2M+mI+MmL2θ+I+mL2M+mI+MmL2u

空间状态方程一般表达式为:

X=AX+BUY=CX+DU ,其中取X=xxθθ ,Y=xθ

由上式可得倒立摆空间表达式为:

xxθθ =001-bI+mL2M+mI+MmL20m2gL2M+mI+MmL200000-bmLM+mI+MmL20M+mmgLM+mI+MmL210xxθθ +0I+mL2M+mI+MmL20mLM+mI+MmL2u

xθ=10000100xxθθ +00u

代入数据可得空间状态方程为:(g取9.8)

xxθθ =001-0.13200.62900000-0.236027.82910xxθθ +09.23702.357u

xθ=10000100xxθθ +00u

因为控制方程为:

M+mx+bx-mLθ=uI+L2θ-mLx-mgLθ=0

对其进行拉普拉斯变换:

M+mXSs2-mLΘSs2+bXSs=U(s)I+L2ΘSs2-mLXSs2-mgLΘS=0

得到摆杆转角与输入力的开环传递函数:

Gs=ΘSU(s)=mLs2M+mI+MmI2s4+bI+mL2s3-M+mmgLs2-bmgLs

取g=9.8,带入数据可得

Gs=ΘSU(s)=27.250s24.098s4+1.021s3-321.795s2-26.705s

即为该系统的传递函数。

Matlab代码如下:

%% 基本参数及传递函数

M = 1.096;%%小车质量

m = 0.109;%%倒立摆的质量

miu = 0.1;%%地面摩擦系数

I = 0.0034;%%惯性矩

L = 0.25;%%长度

g = 9.8;%%加速度

q=(M+m)*(I+m*L*L)-m*m*L*L;

n1=m*L/q;

den1=miu*(I+m*L*L)/q;

den2=-(M+m)*m*g*L/q;

den3=-miu*m*g*L/q;

sysg=tf([n1 0 0],[1,den1,den2,den3,0]);

step(sysg)

2.2、能观能控性分析

在现代控制理论中,能控性和能观性是两个重要的概念,是卡尔曼(Kalman)在1960年首先提出来的,它是最优控制和最优估计的设计基础。能控状态:对于一线性定常系统,如果存在控制输入u(t) ,使得在有限时间内,系统从初始状态x(t0) ,转移至指定的任意终端状态x(tf) ,则该状态是可控的。如果对于所有的状态均可控,则该系统是完全能控的。能观状态:对于一线性定常系统,对于任意的控制输入u(t) ,如果通过观测系统在一段时间内的输出y(t) ,可以唯一地确认系统的初始状态x(t0) ,则该状态是可观的。如果对于所有的状态均可观,则该系统是完全能观的。

%% 状态方程矩阵

P = (M+m)*I+M*m*L^2;%%状态方程的分母

A = [0 1 0 0;

    0 -miu*(m*L^2+I)/P m^2*g*L^2/P 0;

    0 0 0 1;

    0 -miu*m*L/P (M+m)*m*g*L/P 0];

B = [0;(I+m*L^2)/P;0;m*L/P];

C = [1 0 0 0;0 0 1 0];

D = [0;0;];

CONT=ctrb(A,B);

OBSER=obsv(A,C);

rank(CONT);

rank(OBSER);

结果满秩,所以该系统可观可控。

2.3、极点配置法设计

经典控制理论中,闭环传递函数的极点影响着系统运动的模态,要求稳定即使极点全部具有负实部。 同时,极点的分布也影响着运动的瞬态性能,所以理想的办法是根据预期的性能设定相应的指标,求解极点的分布。 利用根轨迹校正法,可以通过在开环系统中增设零点的办法使整个根轨迹向左移动,从而增加系统的相对稳定性,减少系统的调节时间。 而在现代控制理论中,改变极点的分布称之为极点配置,可以通过引入反馈实现。

Matlab代码:

%% 极点配置法

gg=ss(A,B,C,D);%state space

p_ex = eig(A);%%%A矩阵特征值求解,系统极点

p_need = [-3.5+2.9002*j,-3.5-2.9002*j,-12,-12.001];%%极点配置,将系统极点调到复平面,将得到稳定的系统

K1 = place(A,B,p_need);%%AB为系统的状态空间矩阵,向量P中是期望的闭环极点位置,返回值是增益向量。

A1 = A-B*K1;%%极点配置之后的矩阵

p_new = eig(A-B*K1)';%%极点逆向求解,极点配置之后的系统极点(验证极点配置成功与否)

N=1/(-(C-D*K1)*inv(A-B*K1)*B+D);%把开环转换为闭环的传递函数。

Clys=ss(A-B*K1,B*N,C-D*K1,D*N);%创建连续的状态空间模型

% gn=tf(Clys);

step(Clys)

2.4、具体步骤

1、判稳

eig(A)得到原状态空间方程系统极点,进行判稳:

         0

   -0.0830

   -5.2780

    5.2727

2、配置极点

可知有一个正实数根,系统发散,需要将系统极点调到复平面,将得到稳定的系统,那么极点配置的期望极点如何计算?如下所示:

进而得到主导共轭极点:-3.5+2.9002*j,-3.5-2.9002*j。

另有两个极点还需要配置,配置在实轴位置实数大于主导极点的三倍左右位置即可,-12,-12.001。

place(A,B,p_need);%%AB为系统的状态空间矩阵,向量P中是期望的闭环极点位置,返回值是增益向量。-128.8398  -65.2233  201.2667   37.5615。

配置后的极点:

-12.0010 + 0.0000i

 -12.0000 + 0.0000i

  -3.5000 + 2.9002i

  -3.5000 - 2.9002i

配置成功。

4、稳定性分析

原系统:

可知系统是不稳定发散的。配置后极点。


配置后:

图3 极点配置后系统阶跃响应

可知:系统进入百分之五误差带时间为0.75s左右,满足要求调节时间1s要求。超调量最大为5%,满足要求10%以内。

现控报告-- 分析倒立摆系统稳定性、能控性及能观性分析,设计PID控制方案(附matlab) 建立直线一级倒立摆系统的动力学模型,推导该系统的运动方程,求出直线一级倒立摆系统传递函数模型及空间状态方程模型。接着描述了PID控制系统设计原理及PID控制器各校正环节的作用,简要叙述了参数的整定方法。设计了直线一级倒立摆摆杆摆角及小车位置常规单回路控制器,通过Simulink仿真知道常规单回路控制器能控制摆杆摆角,不能控制小车位置。于是设计出了直线一级倒立摆双闭环控制器及基于倒立摆系统的状态空间方程控制器,利用软件进行仿真,仿真结果表明,常规双闭环控制方案和基于状态空间方程加控制方案均能对摆杆摆角及小车位 阅读详情

相关推荐

一级倒立摆控制 —— PID 控制器设计及 MATLAB 实现

在本页中,我们将为倒立摆系统设计一个 PID 控制器。在设计过程中,我们将假设一个单输入、单输出设备,其传递函数如下。除此以外,我们将尝试在不考虑小车位置的情况下控制摆的角度。

机器人控制与仿真应用 1万+

线性系统大作业——2.二阶倒立摆建模与控制系统设计(上)

文章目录0.简介1.建立数学模型1.1.牛顿运动定律分析欧拉-拉格朗日方程分析2.Simulink仿真3.使用SimMechancis仿真4.在平衡点附近模型线性化5.系统能控性、能观性和稳定性分析5.1.能控性分析5.2.能观性分析5.3.稳定性分析5.3.1.Routh-Hurwitz判据 {#c:Routh-Hurwitz判据}Lyapunov函数6.基于极点配置方法的控制器设计7.状态观测器设计7.1.全阶观测器7.2.最小阶观测器8.基于观测器的状态反馈控制8.1.基于全阶观测器的状态反馈控制8.

qq_42731705的博客 1万+

基于Simulink与DQN的倒立摆控制系统设计与实现

马尔可夫决策过程是一个五元组 $(S, A, P, R, \gamma)$,其中:$S$:状态空间(State Space),表示环境中所有可能的状态集合;$A$:动作空间(Action Space),表示智能体可以执行的所有动作集合;$P(s’|s,a)$:状态转移概率函数,描述在状态 $s$ 下采取动作 $a$ 后转移到新状态 $s’$ 的概率;$R(s,a,s’)$:即时奖励函数,表示从状态 $s$ 执行动作 $a$ 转移到 $s’$ 时获得的即时回报;

weixin_42612405的博客 1015

基于神经网络的倒立摆控制系统设计

基于神经网络的倒立摆控制系统设计 问题:一级倒立摆装置如图所示。装在小车上的倒立摆在水平力的作用下,通过控制小车的运动速度使偏转角θ为0,即可使倒立摆直立起来。 一、参数分析 全部的主要参数就是以上七个,其中需要用到的是小车质量M、摆杆质量m、摆杆转动轴心到杆质心的长度l以及摆杆惯量! 二、受力分析(不多赘述,百度一大堆,直接进入数据采集模块) 三、数据采集 这里首先我们打开matlab的help参考页面的搜索Inverted pendulum找到以下这个matlab自带的modol。(这个modol其实

Jesom1a的博客 9820

全国大学生电子设计竞赛—倒立摆系统控制策略探究

圆周倒立摆系统与线性倒立摆系统不同,它具有旋转自由度,因此它的动力学行为更加复杂。此类系统要求控制算法不仅处理摆杆的上下移动,还要处理摆杆围绕支点的旋转运动。自适应控制是一种允许控制器根据系统性能自动调整参数的控制方法。它适用于系统参数未知或者参数可能随时间变化的情况。在自适应控制策略中,控制器会根据系统输出和期望输出之间的差异,动态调整控制参数,以达到期望的性能。模糊逻辑控制使用模糊集合来表示输入和输出变量的模糊状态,例如“快”、“慢”、“左”、“右”等。

weixin_35987118的博客 447

基于LQR算法的倒立摆控制系统设计与仿真

构建倒立摆系统的状态空间模型,首要任务是明确系统的运动自由度并选择合适的状态变量。状态变量的选择直接影响到后续建模的复杂度与控制器的设计效果。对于常见的直线一级倒立摆系统,通常由一个小车在水平轨道上受外力驱动,顶部通过旋转铰链连接一个刚性质点摆杆构成。该系统有两个广义坐标:小车的水平位移 $ x $ 和摆杆的偏转角度 $ \theta $,因此具有两个自由度。动态规划基于“最优性原理”,即无论初始状态和初始决策如何,剩余的决策必须构成关于由第一个决策产生的新状态的最优策略。

weixin_42418754的博客 1269

一级直线倒立摆LQR控制系统研究:经典非线性控制策略的现代化演绎

一级直线倒立摆LQR控制系统研究:经典非线性控制策略的现代化演绎 去发现同类优质开源项目:https://gitcode.com/ 项目介绍 在现代控制理论领域,一级直线倒立摆LQR控制系统研究以其独特的挑战性和理论研究价值,吸引了众多科研工作者的关注。该项目旨在通过线性二次调节器(LQR)对一级直线倒立摆系统进行精确控制,有效解决传统控制方法在精度和实时性上的不足。 项目技术分析 系统特性 一级...

gitblog_06794的博客 854

C++实现倒立摆控制系统的完整指南

倒立摆系统是一个经典的控制理论实验平台,它在工程教育和研究中广泛应用。倒立摆模型模拟了一类不稳定或亚稳态的机械系统,其控制难度较高,能够很好地检验控制算法的性能。本系统的动态特性复杂,由多个物理组件构成,包括摆杆、推杆、基座和传感器等。在后续章节中,我们将探讨如何使用C++语言对倒立摆进行有效的控制,包括系统动力学模型的建立、控制策略的设计以及代码的编写和优化。而本章的重点是对倒立摆系统本身进行描述,为读者提供一个整体的框架认识,以便更好地理解后续章节中复杂的概念和实现细节。

weixin_42599558的博客 928

一级直线倒立摆LQR控制系统研究

一级直线倒立摆LQR控制系统研究 去发现同类优质开源项目:https://gitcode.com/ 本文档详细介绍了针对一级直线倒立摆系统的线性二次调节器(LQR)控制策略设计。一级直线倒立摆作为经典的非线性控制对象,其控制问题的复杂性在于需要同时控制摆杆角度和保持小车位置的稳定。 文档内容概述 系统介绍:阐述一级直线倒立摆的动力学特性,包括其多变量、强耦合的特点。 控制挑战:分析了倒立摆系统对...

gitblog_06702的博客 955

基于Matlab小车倒立摆系统的控制及GUI动画演示(附上源码)

基于Matlab小车倒立摆系统的控制及GUI动画演示(附上源码)

m0_62143653的博客 2295

基于Simulink的小车倒立摆系统仿真与控制全流程实战

模块复用性强:同一控制器可用于不同被控对象;调试隔离性好:可在子系统内部单独运行测试;团队协作友好:不同工程师负责不同子系统开发;版本管理方便:支持SLX文件纳入Git等版本控制系统。为了实现闭环控制,必须将系统输出(如 $x, \theta$)反馈至控制器,同时将控制信号 $u$ 注入动力学模型。此时需合理使用Inport与Outport模块。典型做法如下:- 在“Plant”子系统中,定义两个Outport。

weixin_28888459的博客 1269

基于MATLAB的倒立摆系统控制

摘要 倒立摆系统是由导轨、小车和各级摆杆组成。小车依靠直流电机施加的控制力,可以在导轨上左右移动,位移和摆杆角度信息由传感器测得,目标是使倒立摆在有限长的导轨上竖立稳定, 达到动态平衡。由于倒立摆系统本身所具有的高阶次、不稳定、多变量、非线性和强耦合特性,许多现代控制理论的研究人员一直将它视为典型的研究对象,不断从中发掘出新的控制策略和控制方法,相关的科研成果在航天科技和机器人学方面获得了广阔的...

yin_bu_feng的博客 3万+

MATLAB仿真项目:倒立摆系统分析与控制

倒立摆系统是控制理论中的经典实验平台,它模拟了一个不稳定的物理过程,使得控制算法的稳定性和响应速度能够得到直观的检验。该系统通常由一个可移动的质点,通过连杆固定在一个可旋转的底座上构成。由于倒立摆系统天然的不稳定性质,对其进行有效控制,不仅考验着控制器的设计能力,也是验证控制算法性能的理想工具。

weixin_42173218的博客 530

二级倒立摆建模(一)

目录 一、倒立摆系统简介 二、二级倒立摆模型构建 三、二级倒立摆的线性化模型 四、二级倒立摆的状态空间模型 一、倒立摆系统简介 倒立摆控制系统作为实验装置在控制理论领域的教学与科研工作中担任着不可或缺的角色。在对其稳定控制研究过程中,许多实际抽象的关键问题,如镇定性、鲁棒性以及跟踪性等等,都可以被直观的呈现出来,倒立摆系统可以说为控制界的经典实验装置。倒立摆时刻处于倒置,状态不稳定,只有人为控制能使其达到并保持动态平衡状态。倒立摆通常包含两部分,即可以沿导轨来回运动的小车和小车上通.

龙晨天的博客 2万+

Windows Server 2008 R2装不上VMware Tools?别急,手动安装驱动补丁的保姆级教程来了

本文提供了Windows Server 2008 R2手动安装VMware Tools驱动补丁的详细教程,解决驱动签名验证失败问题。通过获取特定补丁文件、创建安装介质、挂载虚拟机并安装补丁等步骤,帮助用户顺利完成VMware Tools安装,提升虚拟机功能与性能。

weixin_28335283的博客 474

KEPServerEX与三菱iQ-R系列PLC通讯

KEPServerEX与三菱iQ-R系列PLC通讯Mitsubishi Ethernet北京东方鼎晨科技有限公司目 录1. 前言2. 三菱PLC端相关设置3. Kepware端相关设置KEPServerEX是美国PTC Kepware公司生产的具有行业性的连接平台,KEPServerEX支持150多种通讯协议,用于向您的所有应用程序提供单一来源的工业自动化数据。该平台的设计使用户能够通过一个直观的用户界面来连接、管理、监视和控制不同的自动化设备和软件应用程序。KEPServerEX利用OPC(自动化产业的互

qq_28768521的博客 8101

MATLAB滑模控制程序:掌握滑模控制核心算法,助力倒立摆系统控制

MATLAB滑模控制程序:掌握滑模控制核心算法,助力倒立摆系统控制 去发现同类优质开源项目:https://gitcode.com/ 在自动化领域,控制算法的应用至关重要,尤其是对于倒立摆系统这种典型的不稳定系统。今天,我们要为大家推荐一个开源MATLAB滑模控制程序,它不仅能够帮助工程师和学者们深入理解滑模控制原理,还能在实际工程中发挥重要作用。 项目介绍 MATLAB滑模控制程序是一个专门为倒...

gitblog_06795的博客 840

将AAL图谱对应到Yeo7大网络中【原理,代码分析】

本文介绍了将AAL2图谱映射到Yeo7大功能网络的方法。通过整合皮层(Yeo2011)、小脑(Buckner2011)和纹状体(Choi2012)三个区域的功能网络图谱,采用投票机制确定每个AAL区域的网络归属。具体步骤包括:1)统计每个AAL区域体素在各网络图谱中的分布;2)选择体素数量最多的网络作为该区域的最终标签。该方法实现了从解剖结构到功能网络的映射,可获得120个AAL区域对应的7大功能网络标签。

yes666666的博客 2227

MATLAB直线倒立摆控制系统专题研究-PID控制+SIMULINK仿真——BJTU

本文运用了自动控制原理的知识,对一维直线倒立摆系统进行PID控制分析。使用MATLAB语言和Simulink仿真模块,以及其中的线性化工具箱,对不同输入下的系统响应进行了分析

weixin_74999972的博客 3455

用STM32L552驱动AD9102:一个硬件工程师的实战避坑指南(附完整代码)

本文详细介绍了如何使用STM32L552微控制器驱动AD9102任意波形发生器芯片,从硬件设计到波形生成的完整实战指南。内容包括电源架构、时钟电路设计、输出调理电路等关键硬件设计要点,以及软件驱动架构、波形存储优化和典型波形生成实例。通过实战经验分享,帮助硬件工程师避开常见设计陷阱,提升开发效率。

weixin_30889885的博客 337

《矩阵论》学习笔记(四):4.2 矩阵的QR分解

《矩阵论》学习笔记(四):4.2 矩阵的QR分解 文章目录《矩阵论》学习笔记(四):4.2 矩阵的QR分解一. Givens矩阵与Givens变换1.1. 概念与理解1.2. Givens矩阵求解方法二. Householder矩阵与Householder变换2.1. 概念与理解2.2. Householder矩阵求解方法2.3. Givens变换与Householder变换的关系三. 矩阵的QR...

shine的博客 3681

这个会跳舞的小车有点东西——用MATLAB玩转倒立摆

直接上硬菜,先看现场表演:在MATLAB的GUI界面上,小车载着细杆左右漂移,突然给个干扰力,杆子晃两下居然又站稳了!这里的门道在于Q矩阵的第三项特别大,相当于告诉控制器:"杆子的角度最重要,给老子盯紧了!使用matlab2022a或者高版本仿真,运行文件夹中的tops.m或者main.m。同时,也可以获取小车轮子转动的圈数N(可以精确到小数)和杆相对于垂直位置的倾角α.同时,也可以获取小车轮子转动的圈数N(可以精确到小数)和杆相对于垂直位置的倾角α.小车的轮子由电机控制,可以控制小车电机的转动力矩M。

TCtvmTLXe的博客 807

sap销售发货的流程_SAP销售订单发货后如何实现发票的自动创建?

问SAP销售订单发货后如何实现发票的自动创建?答业务场景有些快消零售企业,SAP系统单据量大,单据金额少,一般在销售发货后即可确认收入。此时无需人工在系统内操作VF01或者VF04进行开票操作,可将该操作设置成后台作业进行自动批量开票,具体操作如下:1、定义任务:VF06输入完以上信息,点击保存进入以下界面:说明:当前日期的意思是“开票的日期”等于“系统电脑中的当前日期”当前日期+/-...

weixin_42358409的博客 3376

基于模糊PID控制的一阶倒立摆(小车型)simulink 仿真(毕业设计报告+仿真模型+代码)

本文聚焦于一阶倒立摆(小车型)这一典型多变量、非线性、强耦合且自然不稳定的系统,旨在探索有效的控制方法以实现其稳定控制。通过牛顿力学分析建立直线一阶倒立摆实物系统的线性状态方程,明确系统的不稳定性、能控性与能观性。深入研究了传统PID控制算法与模糊控制算法,并设计相应控制器,利用Matlab/Simulink仿真对比分析两种算法的优缺点。针对经典控制理论在单输入两输出的一阶倒立摆系统中无法实现稳定控制的局限性,提出模糊PID控制策略,为后续研究提供理论依据与仿真基础。

weixin_51881187的博客 810

从一只龙虾到一支团队:OpenClaw 单 Bot 多 Agent 配置实践

单 Bot 多 Agent只有一个对外的聊天入口(飞书 Bot)内部有多个独立的 AI Agent,各司其职主 Agent(总指挥)负责接收任务并分配给子 Agent子 Agent 完成任务后将结果返回给主 Agent角色Agent ID职责使用场景🎯 总指挥main-agent统筹协调,任务分发接收所有用户请求✍️ 笔杆子内容创作公众号、博客、小红书🔬 参谋canmou深度研究竞品分析、市场调研📋 运营官operations运营管理邮件、日历、社交媒体。

Maynor的博客 1085

手把手教你学simulink(69.3)--毫米波5G/6G 系统场景实例设计并实现基于Simulink的毫米波多用户MIMO通信系统模型

毫米波频段(30 GHz到300 GHz)因其高带宽和高速率特性,成为5G和未来6G通信系统的理想选择。然而,毫米波信号的传播特性较差,容易受到大气吸收、雨衰、建筑物遮挡等因素的影响。为了克服这些挑战并提高通信容量,多用户MIMO(MU-MIMO, Multi-User Multiple-Input Multiple-Output)技术被广泛应用。多用户MIMO技术通过在基站和多个用户之间同时传输多个数据流,充分利用空间资源,从而显著提升系统容量和频谱效率。

MHD0815的博客 496
上一篇: 系统辨识matlab代码
Guohui ZHOU
博客等级 码龄6年 0粉丝 2原创
评论
成就一亿技术人!
拼手气红包6.0元
还能输入1000个字符
 
 条评论被折叠 查看
添加红包

请填写红包祝福语或标题

个

红包个数最小为10个

元

红包金额最低5元

当前余额3.43元 前往充值 >
需支付:10.00元
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包
实付元
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明:

1.余额是钱包充值的虚拟货币,按照1:1的比例进行支付金额的抵扣。
2.余额无法直接购买下载,可以购买VIP、付费专栏及课程。

余额充值
⌂ 换网址