双自由度控制器
基于DOB和二自由度控制器的某火炮稳定控制系统设计
基于DOB和二自由度控制器的某火炮稳定控制系统设计王海稳;曲俊海;孙汉青;庞继文【摘要】The artillery stability control system performance can be influenced by the external disturbance such as the road condition,the impact moment caused by the gun firing,the change of the friction torque,the measurement noise,the change of the moment of intertia and so on.Order to solve this problem,a DOB observer and two degree of freedom control algorithm is introduced to reduce the influenc of friction on the performance of the system,and to improve the ability of the system to isolate the disturbance of the carrier.Simulation and experimental results show that the proposed algorithm can effectively improve the stability accuracy and speed servo performance of the system.%火炮稳定控制系统性能会受到如路况、火炮射击时产生的冲击力矩等外部扰动以及摩擦力矩变化、测量噪声、转动惯量变化等内部参数摄动的影响.针对此问题,引入一种DOB 观测器和二自由度控制算法,来减少摩擦对系统性能的影响,提高系统对载体扰动的隔离能力.仿真和实验结果表明,所提出的算法可以有效提高系统的稳定精度和速度伺服性能.【期刊名称】《火力与指挥控制》【年(卷),期】2016(041)012【总页数】4页(P117-120)【关键词】炮控系统;二自由度;DOB;稳定精度【作者】王海稳;曲俊海;孙汉青;庞继文【作者单位】太原科技大学自动化学院,太原 030024;北方自动控制技术研究所,太原 030006;北方自动控制技术研究所,太原 030006;北方自动控制技术研究所,太原030006【正文语种】中文【中图分类】TP273;TJ3火炮稳定控制系统(以下简称“炮控系统”)是火控系统的重要组成部分,作为火力控制主线末端的执行系统,发挥着控制火炮/炮塔指向和隔离载体扰动的作用,是实现火控系统主要战技指标的重要保证。
二自由度PID
2、其微分环节采用了不完全微分的微分先行 所谓不完全微分是指在微分环节TdS中加了一个 的低 通滤波器。微分信号的引入可以改善系统的动态特性, 但可能 会引入高频干扰, 加入了一阶惯性环节后可有效抑制高频干扰。 比较式(1)和式(2)发现,二自由度PID算法的分子项中的 控制算法为GPI(s) ,无微分作用;而普通PID算法的分子项中的 控制算法为(GPI(s) +GD(s)). 所谓微分先行是指微分环节只对输出量进行微分而不对给定 值微分, 其优点是当给定值变化时(给定值变化通常会比较剧 烈), 由于没有微分可以避免系统可能产生的振荡;而当输出 发生变化时(输出变化通常比较缓和),由于加入微分可以缩 短过渡过程,从而改善系统动态响应。
综上所述,二自由度控制算法的核心是其对给定值的响 应和对扰动的响应采用了不同的控制算法,这也是二自由 度名称的由来。 对于给定值,控制算法是一个目标滤波器加比例积分算 法,这样可以有效抑制超调;
对于扰动,控制算法是一个采用了不完全微分的比例积 分微分算法,这样可以有效改善系统动态响应。
三、2DOF-PID的相关研究
传统PID与二自由度PID仿真结果对比图
谢谢
二自由度PID算法ຫໍສະໝຸດ (2DOF-PID)2DOF-PID概述
一、 2DOF-PID的基本概念 二、 2DOF-PID的特点 三、 2DOF-PID的研究与应用
一、 2DOF-PID的基本概念
常规PID控制方案因其良好的控制性能,目前仍然是工 业过程控制中采用最多的控制形式。由于常规PID只能设 定一种控制参数,所以又称为一自由度PID控制(1DOF)。 这种方法存在着一定的局限性,只能较好地满足其中的 一种特性,若整定好抗扰性能的参数值,则系统设定值的 跟随性能较差,或者按跟随特性进行调节器参数整定,则 抗扰动性能变差。
两自由度并联机器人控制系统设计
两自由度并联机器人控制系统设计谌孙杰;马璐;吴秋平【摘要】To fit the demand of automatic pick and place in the manufacture process of medicine packaging and electromechanical assemb-ling,a high-speed 2-DOF parallel robot using linear servo technology is designed in this thesis.Firstly,the mechanical structure design of the robot is introduced,according to the results of kinematics analysis,the workspace of the 2-DOF parallel robot is obtained via Monte-Carlo method and geometrical method.Secondly,a control system consist of MCU and CPLD (STM32F103+MaxII)is adopted,an effi-cient approach to generating motion curve programs in MCU is proposed based on workspace.And we use DDS (Direct Digital Frequency Synthesizer)to generate square wave in accordance with motion parameters,then we transform square wave to differential signals which will be sent to servo driver.In the design of communication between the two controllers,a two stage data buffer is presented by rational use of state machine in CPLD,which can realize the interleave of MCU read and CPLD write to achieve seamless refresh of data.Finally we com-plete the manufacture and adjustment of the robot demo,the results shows that the performance of the 2-DOF parallel robot system is sta-ble and reliable,at the same time the robot can pick and place the prill quickly.%针对机电装配、医药包装等行业自动化抓取和放置实际应用的需求,设计了一种采用直线伺服驱动技术的两自由度高速并联机器人;首先进行了机器人的机械结构设计,并且通过运动学分析,结合运用蒙特卡洛法与几何法求解出并联机器人的工作空间;其次采用MCU+CPLD (STM32F103+MaxⅡ)的双控制架构,根据工作空间结构在 MCU 中设计出高效的运动轨迹生成算法,并在CPLD中运用DDS技术将伺服运动参数转换成脉冲经一级差分后输出到伺服驱动器;在双控制器的通信方面合理利用CPLD中的状态机提出了双级数据缓冲方式,使得MCU写与CPLD读交错进行,可以实现数据的无缝刷新;最后进行了并联机器人系统样机的制作与调试,分析结果表明所研制的机器人控制系统能够使机器人快速抓放金属小球,实现稳定可靠运行。
二自由度手控器
摘要遥操作系统是指在人的操作下,对处于人难以接近或对人体有害的环境中,完成比较复杂操作的一种远距离操作系统。
其工作模式是:操作者对主机械手进行操作,将运动指令通过电波、计算机网络等传输媒介传送给从机械手,从机械手按照接收到的命令在特定环境下进行工作,同时将自己的工作状态返回给操作者,便于操作者作出正确的决策。
手控器是人与机器人之间的一个重要的人机接口,是人们感知操作环境,并完成对遥控机器人进行控制的重要的中间信息媒介。
本设计是2自由度、通用型、异构式手控器。
这种装置可实现2个转动自由度、同时能够进行力反馈。
该装置由两个转动框架构成,各轴两端分别安装有直流力矩电机和角位移传感器。
力矩电机用以实现力觉的再现,角位移传感器用于获取各转动部件的转角信息。
在结构设计时实现了两个自由度运动的解耦,便于简化控制算法,实现运动控制。
经过方案论证、比较,确定出设计方案,根据人机工程学原理,采用PRO-E设计出零件的装配图,根据具体的设计要求和实际的允许条件确定出各个主要零、部件的具体尺寸以及电机、传感器的选用型号。
关键词:遥操作机器人手控器力反馈临场感AbstractRemote control system is in the operation, the right people in inaccessible or hazardous to health of the environment, to complete a more complex operation of remote operating system. Its mode of operation: the operator to operate master manipulator, the directive will campaign through radio, computer networks and other media transmitted to the transmission from the mechanical hand, from the mechanical hand to receive the order in accordance with specific circumstances in the work, at the same time, to return to their work status To the operator, for the operator to make the right decisions.Manipulator between robots and people is a major human-machine interfaces is that people are aware operating environment, and complete control of a remote control robot to the middle of the important information media.The design is 2 degrees of freedom, universal, heterogeneous-manipulator. This device can be realized two rotational degrees of freedom, and to carry out force feedback. The devices pose a framework by the two rotation, the shaft were installed at either end of a DC motor torque and angular displacement sensor. Torque motor to achieve a replay of force, the angular displacement sensor for access to all parts of the rotation angle of information. In the design of the structure has two degrees of freedom of movement is decoupling, for simplified control algorithms, and movement control.After demonstration programme, compared to identify design options, according to ergonomic, a PRO-E design parts of the assembly, in accordance with the specific design requirements and determine the actual conditions to allow each of the major parts and components as well as the specific size Motors, sensors selection of models.Key words:remote robot manipulator force feedbacktelepresence目录1 绪言 (1)1.1引言 (1)1.2选题依据和现实意义 (2)1.3主从式遥操作机器人系统的发展综述 (3)1.3.1主从式遥操作机器人系统概述 (3)1.3.2主从式遥操作机器人的发展与应用 (4)1.3.3 遥操纵系统主手的分类 (6)1.3.4 力反馈遥操作装置的研究与发展状况 (8)2 手控器的设计基础 (15)2.1以人机工程学为基础的主操作手设计理论 (15)2.1.1人机工程学概述 (15)2.1.2人机工程学研究的主要内容 (16)2.1.3人体触觉 (16)2.2 手控器的主要技术性能与设计准则 (19)2.2.1 手控器机械结构的特点 (19)2.2.2 手控器的设计准则 (20)2.3 力反馈主操作手的设计流程 (21)3 手控器的结构设计 (23)3.1 临场感遥操作机器人系统的构成原理 (23)3.2遥操作机器人系统的总体设计方案 (24)3.2.1遥操作机器人系统控制方法的选择 (24)3.2.2遥操作机器人系统控制方案 (26)3.3 2自由度、通用型、异构式手控器的总体设计 (28)3.3.1 总体结构及其特点 (28)3.3.2手动转动机构的组成与工作原理 (29)3.4 电机的选择 (29)3.4.1电机的选用原则 (30)3.4.2电机的选用型号 (31)3.4.3电机驱动电路 (32)3.5角位移传感器的选用 (33)3.5.1传感器的组成及特性 (33)3.5.2角位移传感器的选用 (34)3.6 力/力矩传感器的选用 (36)3.6.1 电阻应变式传感器的原理 (36)3.6.2 电阻应变片的基本结构 (37)3.6.3 力/力矩传感器的设计 (38)3.7 主要零部件的设计 (41)3.7.1 八角框架的设计 (41)3.7.2 X轴及Y轴的设计 (42)3.7.3 转轮的设计 (42)3.7.4 框架转轴的的设计 (44)3.7.5 手控器轴承的选择 (44)3.8 手控器的表面处理 (45)4 主手控制器的硬件实现 (46)4.1 主手控制器的原理 (46)4.2 USB协议介绍 (47)4.2.1 USB出现原因和发展 (47)4.2.2 USB总结拓朴结构 (48)4.2.3 USB的传输方式 (48)4.3 数据采集、转换电路 (49)5.结论 (51)致谢 (52)参考文献 (53)1 绪言1.1引言随着人类作业领域的不断增大,需要人类在一些很难接近或者对人有害的环境中进行作业,因此有必要研究开发出能够主动适应环境变化的智能型机器人。
二自由度运动控制系统
二自由度运动控制系统KNT-PHT2预习报告班级:自动化4班学号:201132010417姓名:罗滨一、实验目的1.掌握二自由度运动控制系统实训装置的基本组成2.掌握设备基本部件的作用二、实验设备1.二自由度运动控制系统实训装置2.AC 220V 电源三、KNT-PHT2 实训装置的基本构成及特点1、二自由度运动控制系统在理解和掌握气动应用和位置控制原理的基础上,利用PLC 或其他控制器实现对其控制,利用设备控制面板上的模式旋钮来选择自动/手动的运行方式,该实训装置主要由二维画笔和电控系统两大部分所组成。
(1)、二维画笔二维画笔由二维十字滑台、工作台、画笔台、控制盒及实训桌等组成。
a 二维十字滑台结构:二维十字滑台主要X 轴滚珠丝杠副运动机构和Y 轴滚珠丝杠副运动机构所组成。
Y 轴滚珠丝杠副运动机构是直接安装在实训桌面的,X 轴滚珠丝杠副运动机构是安装在Y 轴滚珠丝杠副运动机构的滑块上面的,这样X 轴滚珠丝杠副运动机构、Y 轴滚珠丝杠副运动机构就组合成了一个二维十字滑台滚珠丝杠副运动机构:滚珠丝杠副运动机构由前后支撑块、驱动电机(伺服电机)及支架、导柱、滑块、滚珠丝杠副以及磁簧开关等器件构成。
其中,滚珠丝杠副运动机构由前后支撑块、驱动电机(伺服电机)及支架、导柱、滑块、滚珠丝杠副以及磁簧开关等器件构成。
特点:当驱动电机转动时,由于电机轴与滚珠丝杠副运动机构的滚珠丝杠副通过弹性联轴器连接,所以滚珠丝杠与电机同步转动,而装在滚珠丝杠副上面的螺母块是与滑块位固定在一起的,螺母块会随着滚珠丝杠副的正反转动做左右运动,所以滑块沿着两根导柱做直线运动。
此外,滚珠丝杠副运动机构的原点位置是用磁簧开关检测定位的,并在两端的极限位置上安装了硬限位开关(磁簧开关),可有效防止由于运行超程而引起的机械或电气设备的损坏。
该运动机构具有行走阻力小、运行平稳、精度高等特点,通过伺服电机驱动,可以实现高精度的定位控制和比较复杂的轨迹运动控制。
永磁同步电机调速系统的一种新型二自由度控制器
永磁同步电机调速系统的一种新型二自由度控制器左月飞;符慧;刘闯;胡烨;张涛【摘要】在永磁同步电机调速系统中,基于扰动观测器的传统二自由度控制系统对阶跃输入的跟踪性能与其抗扰性能之间存在耦合,因此控制器的参数整定过程比较复杂.提出了一种新型二自由度控制器.这种新型控制器利用更高一阶的扩张状态观测器取代传统控制器中的扰动观测器,同时对转速和扰动转矩进行观测.利用观测的转速和扰动转矩分别作为反馈量和前馈补偿量,从而实现系统跟踪性能与抗扰性能的完全解耦,进而简化控制器的参数整定过程.最后通过实验验证了所提方法的有效性和实用性.【期刊名称】《电工技术学报》【年(卷),期】2016(031)017【总页数】7页(P140-146)【关键词】永磁同步电机;扰动观测器;扩张状态观测器;参数整定;解耦;二自由度控制器【作者】左月飞;符慧;刘闯;胡烨;张涛【作者单位】南京航空航天大学自动化学院南京210016;南京航空航天大学自动化学院南京210016;南京航空航天大学自动化学院南京210016;南京航空航天大学自动化学院南京210016;南京航空航天大学自动化学院南京210016【正文语种】中文【中图分类】TM351传统的永磁同步电机(Permanent Magnetic Synchronous Motor,PMSM)调速系统大多采用双环线性控制结构,内环为电流环,外环为速度环,多采用PI控制器。
常规的PI控制器只有一个可调参数,是一种一自由度控制器,不具备使系统同时获得良好的跟踪性能和抗扰性能的能力,参数整定时一般要在系统的跟踪性能和抗扰性能之间进行折中选择[1-3]。
这样的做法一般能满足大多数控制系统的要求,但对于高性能的控制系统,常难以兼顾各方面的性能要求而获得满意的控制效果[4]。
为解决以上问题,出现了两种解决思路:一种是基于内模控制的二自由度(Two-degree-of-freedom,2DOF)PI控制器[4-8],这种控制器有很多结构形式,其中比较典型的是文献[4]中的结构,将传统内模控制器中前向通道上的一个环节移动至给定通道和反馈通道上,利用给定通道上的传递函数调节跟踪性能,利用反馈通道上的传递函数调节抗扰性能;另一种是基于扰动观测器(Disturbance Observer,DOB)的2DOF鲁棒控制器[9-14],它包含反馈控制器与DOB两部分,通过DOB 对扰动进行观测并前馈补偿,从而调节系统的抗扰性能,而跟踪性能则由反馈控制器进行调节。
基于h∞控制理论的二自由度内模控制器设计
基于h∞控制理论的二自由度内模控制器设计
基于H∞控制理论的二自由度内模控制器设计是近几年在系统控制
领域中受到越来越多关注的话题,代表着一种新型的控制理论和设计
方法。
H∞控制理论利用H∞优化原理设计控制系统,能够有效抑制外
界干扰和系统本身不确定性的影响,从而有效达到系统性能的提升。
本文将简要阐述基于H∞理论的二自由度内模控制器设计的具体步骤以
及实现方法。
首先,在二自由度内模控制器设计中,需要对系统模型进行建模,通过系统建模可以得到系统的状态空间模型,包括状态方程和输出方程。
然后,根据状态空间模型,采用H∞优化原理,设计预测模型以及
控制器模型,进行系统的输出预测以及控制输出的实现。
接下来,使
用数学建模软件对设计的模型进行验证,确保其精确性,并采用仿真
软件对设计的模型进行整体仿真验证,检验系统收敛性和稳定性。
最后,将控制器或者数控系统编制成工程代码,然后在物理系统中进行
实现。
总而言之,基于H∞控制理论的二自由度内模控制器设计具有抑制
外界干扰和系统本身不确定性的能力,精确实现系统控制以及提升系
统性能的优点。
面对日益复杂的系统控制需求,H∞控制理论为实现系
统控制提供了一种新的思路和设计方法。
基于PSO算法的大时滞过程双自由度内模控制器设计
基于PSO算法的大时滞过程双自由度内模控制器设计作者:汤伟袁志敏党世红来源:《中国造纸学报》2018年第03期摘要:借助双控制器设计技术和粒子群优化(PSO)算法,提出了一种基于PSO算法的双自由度内模控制方法,即PSOTDFIMC,并用于对大时滞工业过程的控制。
该方法的基本思想是:以时间乘误差绝对值积分(ITAE)为目标函数,运用PSO算法,优化整定IMC滤波器时间常数。
MATLAB仿真结果表明, PSOTDFIMC具有算法简单、搜索速度快、效率高等优点,可明显提高双自由度内模控制系统的设定值跟踪性能和鲁棒性能。
关键词:大时滞过程;双自由度IMC;PSO算法;滤波器时间常数优化中图分类号:TS736;TP312文献标识码:ADOI:1011981/jissn1000684220180343内模控制(IMC)对大时滞过程具有良好的控制效果,但常规的IMC只有一个自由度,其不具有使系统的目标跟踪特性和干扰抑制特性同时达到最佳的能力[1]。
基于以上原因,本研究采用双自由度内模控制(TDFIMC),使系统控制性能达到最佳。
然而对于TDFIMC而言,控制器参数整定是一个重要问题。
卫开夏采用Taylor级数展开的方法整定参数[2],邢卓异等采用幅相裕度参数整定方法优化参数[34],孙功武等利用最大灵敏度函数整定滤波器时间常数[5],Kennedy I等利用时间乘误差绝对值积分(ITAE)指标函数对滤波参数呈单峰性的特点,采用黄金分割法对常规IMC参数进行优化[6]。
然而,上述整定方法計算量大,往往需根据经验对参数进行试凑整定,对参数的整定具有一定的盲目性。
本研究以ITAE为目标函数,运用粒子群优化算法(PSO)对控制器滤波器时间常数进行整定。
该算法具有算法简单、搜索速度快、效率高等优点,其基于PSO算法的TDFIMC控制策略避免了参数整定优化的盲目性,在保证快速性的同时,确保闭环系统具有良好的跟踪性能和鲁棒性能。
二自由度云台非线性反步控制器设计
第27卷㊀第4期2023年4月㊀电㊀机㊀与㊀控㊀制㊀学㊀报Electri c ㊀Machines ㊀and ㊀Control㊀Vol.27No.4Apr.2023㊀㊀㊀㊀㊀㊀二自由度云台非线性反步控制器设计黄金杰1,2,㊀梁恒愉3,㊀宫煜晴3,㊀汪文1,㊀孙晓波1(1.哈尔滨理工大学自动化学院,黑龙江哈尔滨150080;2.黑龙江省复杂智能系统与集成重点实验室,黑龙江哈尔滨150080;3.哈尔滨理工大学计算机科学与技术学院,黑龙江哈尔滨150080)摘㊀要:针对二自由度云台的跟踪控制问题,依据反步法控制思想,提出一种基于增广李雅普诺夫函数的反步控制器设计方法㊂首先建立二自由度云台的非线性数学模型,并为模型的机械子系统设计了虚拟输入,根据实际控制目标求解虚拟输入的具体表达式㊂其次基于增广李雅普诺夫函数,引入跟踪误差将机械子系统改写为线性微分方程,利用其特征方程根的特点,推导系统实际的控制律,以及控制器参数需满足的条件㊂最后数值实例采用了电动云台拍摄系统远距离跟踪拍摄风电叶片表面图像,对水平和俯仰方向追踪风机叶片上某一目标点的期望轨迹进行仿真,系统经过4.05s 可达到预期跟踪性能,验证了所提方法的有效性㊂关键词:非线性系统;二自由度云台;反步法;虚拟输入;增广李雅普诺夫函数;全局渐近稳定DOI :10.15938/j.emc.2023.04.015中图分类号:TP23文献标志码:A文章编号:1007-449X(2023)04-0148-07㊀㊀㊀㊀㊀㊀㊀㊀㊀㊀㊀㊀㊀㊀㊀㊀㊀㊀㊀㊀㊀㊀㊀㊀㊀㊀㊀㊀㊀㊀㊀㊀㊀㊀㊀㊀㊀㊀㊀㊀㊀㊀㊀㊀㊀㊀㊀㊀㊀㊀㊀㊀㊀㊀㊀㊀㊀㊀㊀㊀㊀㊀㊀㊀㊀㊀㊀㊀㊀㊀㊀㊀㊀㊀㊀㊀㊀㊀㊀㊀㊀㊀㊀㊀㊀㊀㊀㊀㊀㊀㊀㊀㊀㊀㊀㊀㊀㊀㊀㊀㊀㊀㊀㊀㊀㊀㊀㊀㊀㊀㊀㊀㊀㊀收稿日期:2022-02-22基金项目:国家自然科学基金(61305001);黑龙江省自然科学基金(F201222)作者简介:黄金杰(1967 ),男,博士,教授,博士生导师,研究方向为学习控制㊁自适应控制;梁恒愉(1992 ),男,博士研究生,研究方向为优化算法㊁学习控制研究;宫煜晴(1996 ),女,博士研究生,研究方向为切换控制系统㊁变参数系统;汪㊀文(1994 ),男,硕士,研究方向为系统辨识㊁学习控制;孙晓波(1964 ),男,教授,研究方向为数字控制㊁现代控制理论㊂通信作者:黄金杰Nonlinear backstepping controller design fortwo-degree-of-freedom pan-tiltHUANG Jinjie 1,2,㊀LIANG Hengyu 3,㊀GONG Yuqing 3,㊀WANG Wen 1,㊀SUN Xiaobo 1(1.School of Automation,Harbin University of Science and Technology,Harbin 150080,China;2.Heilongjiang Provincial Key Laboratory of Complex Intelligent System and Integration,Harbin 150080,China;3.School of Computer Science and Technology,Harbin University of Science and Technology,Harbin 150080,China)Abstract :For the tracking control problem of two-degree-of-freedom (2-DOF)pan-tilt,a backstepping controller design method based on augmented Lyapunov function is proposed by the backstepping control.Firstly,a nonlinear mathematical model was established for the 2-DOF pan-tilt,and was converted into a state-space form.The specific expression of a virtual input which is designed for the mechanical subsys-tem can be solved according to the actual control target.Secondly,the mechanical subsystem was rewrit-ten into a linear differential equation by introducing tracking error based on an augmented Lyapunov func-tion,while the roots of its characteristic equation was used to find the actual control law of the system and the controller parameters conditions.Finally,in the numerical example,an electric pan-tilt camera sys-tem was used to track the wind turbine blade surface image from distance,and the desired trajectory of a target point on the wind turbine blade was tracked in the horizontal direction and the pitch direction to-gether.The experiment results show that the system can achieve the desired tracking requirements after4.05s,which verifies the effectiveness of the proposed method.Keywords:nonlinear system;two-degree-of-freedom pan-tilt;backstepping method;virtual input;aug-mented Lyapunov function;global asymptotic stability0㊀引㊀言在实际工业领域中,电动云台被广泛使用㊂在控制信号作用下,电动云台可以让其搭载的设备按照指定的速度㊁角度或按照预期的轨迹来运行,例如将电动云台应用于军舰炮台旋转,如果敌方导弹靠近而军舰无法迅速躲避时,可以通过云台搭载武器旋转拦截目标;巡检机器人上应用的云台可完成高效率㊁多角度的巡检工作;卫星信号接收器底部的云台搭载信号接收器可以寻找最优角度接收卫星信号;其中云台搭载摄像机(pan-tilt-zoom,PTZ)等设备实现自动变焦㊁扩大扫描范围㊁监视周围环境的系统应用更加普遍㊂例如文献[1]中提出了一种基于二自由度云台摄像机的人工地标低成本定位系统,利用二自由度云台辅助相机跟踪地标,扩大识别范围㊂许多学者对云台进行了研究[2],例如J.M. Hervé[3]就云台本身的机械结构提出了一种新的二自由度机制,使得水平方向的角度和垂直方向的角度以完全不耦合的方式进行控制㊂另外,云台应用的成果也颇为丰富:例如Robin Yosafat S等人[4]将照相机作为视觉传感器与二自由度伺服云台结合,提出了一种人脸跟踪系统的设计方案,该方案比较了超前滞后补偿器和PID控制方法,通过实验验证表明了PID控制的水平和垂直方向的瞬态响应都快于超前滞后补偿器;Agus Ramelan等人[5]也设计了一种基于二自由度伺服云台的人脸跟踪系统,在控制器设计方法上提出了一种基于仿真的线性二次型控制器(linear quadratic controller,LQC),这种LQC 控制器的输出可以为人脸跟踪控制系统连接的伺服控制系统提供一个参考,更好地满足水平和垂直方向的响应和超调率设计需求㊂肖杨等人[6]针对二自由度视觉伺服云台中相机采样率低的缺陷,基于角度与像素之间的转换关系,提出了一种双环结构的控制方案,取得了较好的控制效果,对响应速度和超调量要求较高的控制器设计有一定的指导意义㊂上述所提出的控制器设计方法都是关于线性控制器的设计方法,基于线性控制理论的结果使用了系统动力学的线性近似,所以控制器通常只在线性化点附近有较好的控制效果㊂要想使电动云台在整个工作范围内都取得较好的控制效果,其相应的控制器则需要基于电动云台的非线性模型进行设计㊂例如,Leng X等人[7]将模糊逻辑算法与滑模控制策略相结合,提出了一种由超声波电机驱动的PTZ系统,解决了传统PTZ系统精度较低㊁鲁棒性较差的问题㊂仇笑天[8]针对传统PID控制算法在面对非线性和参数不确定系统时难以取得较好控制效果的问题,引入模糊控制对PID参数进行实时整定,构建了模糊自整定PID控制器,并对PID控制器参数和模糊控制器的量化因子通过布谷鸟搜索算法(cuck-oo search,CS)进行调整,使所设计控制器达到了预期控制效果,具有良好的控制能力㊂除了通过引进模糊算法或者其他算法改进传统控制方法以应对非线性系统的控制之外,还可以考虑本身就具备处理非线性系统控制问题的方法,如反步法㊂例如Mouhacine Benosman等人[9]对电磁执行器利用反步法设计非线性控制器使得其控制性能得到有效提高㊂刘燕斌等人[10]针对高超音速飞机纵向运动的数学模型具有严重非线性㊁不稳定㊁多变量耦合的特点,采用非线性动态逆控制与反步法相结合的方法为其设计飞行控制系统,以确保高超音速飞机的纵向稳定性,改善其飞行品质㊂这些研究表明反步法为非线性系统控制问题提供了一个很好的思路㊂受上述学者启发,本文为实现一类二自由度电动云台的跟踪控制[11],分别对云台的水平轴运动和俯仰轴运动建立了非线性数学模型,采用反步控制法直接设计非线性水平轴控制器和俯仰轴控制器,无需对模型进行线性化处理,相比传统线性化控制方法能够更加有效跟踪目标的运动轨迹㊂在控制器设计过程中,根据实际跟踪目标,通过设计虚拟输入,将跟踪问题简化为一个关于待设计参数的线性模型稳定性问题,并利用增广李雅普诺夫函数推导出非线性反步控制律,直接处理了系统模型中的非线性项㊂最后结合LaSalle-Yoshizawa定理[12]证明了电动云台系统的全局渐近稳定性,通过电动云台平滑跟踪拍摄风机叶片目标点的实例验证本文方法的优越性㊂941第4期黄金杰等:二自由度云台非线性反步控制器设计1㊀系统模型为建立二自由度电动云台在水平轴上的动力学系统模型,假设水平轴电机的电枢电流和电枢运动范围在磁通线性区域,不考虑线圈产生的磁场中磁通饱和区域[13],那么根据电机的的机械运动特性和基尔霍夫电压平衡方程可得到Jd ωd t+fω=k a i ;a b +θd i d t +Ri +ai (b +θ)2d θd t=u ㊂üþýïïïï(1)式中:J 为电机转动惯量;f 为总摩擦系数;θ为角位移;ω为角速度;k a 为转矩常数;i 为电枢电流;u 为电枢电压;R 为电枢回路总电阻;a 和b 是线圈的常量参数;a /(b +θ)为电枢回路总电感;d θ/d t 为电机反电势㊂后文用 ㊃ 表示欧几里得范数,即对x ɪR n ,有 x =x T x ;用(.)㊃和(.)㊃㊃表示函数或变量对时间的一阶和二阶导数;用C k 表示k 阶可导函数的集合;用(.)T 表示向量或矩阵的转置㊂针对云台水平轴动力学系统(1),定义一个状态向量z =[z 1,z 2,z 3]T=[θ,θ㊃,i ]T,控制目标是使变量[z 1,z 2]T跟踪时变角度和角速度轨迹z ref 1(t ),z ref2(t )=z ㊃ref 1(t ),其中z ref i(t )ɪC k(k ȡ2,i =1,2)㊂于是,可以将原系统模型(1)改写为非线性状态空间模型为z ㊃1=z 2;z ㊃2=k a J z 3-f Jz 2;z ㊃3=-b +z 1a Rz 3-z 2z 3b +z 1+b +z 1au ㊂üþýïïïïïï(2)本文研究的二自由度云台在水平轴和俯仰轴上各由独立的电机进行控制,两轴之间基本没有耦合关系,根据对称性,俯仰轴模型与水平轴模型一致,不再赘述㊂为方便解释后续章节的控制器设计与稳定性分析等部分,下面给出相关定义定理的说明㊂定义1[14]㊀∀x ɪR n ,有V (x ):R n ңR +,当x ңɕ时,有V (x )ңɕ,则称V (x )径向无界㊂定义2[15]㊀若存在常数k >0,使得定义域D内的两个任意实数x 1㊁x 2均有 f (x 1)-f (x 2) ɤk x 1-x 2 成立,则称f (x )在定义域D 上满足Lipschitz 条件,f (x )在定义域D 上一致连续㊂定义3[16]㊀考虑如下系统x ㊃=f (x ,t );x (t 0)=x 0㊂}(3)其中,x ɪR n ,f (x )在定义域D 上连续且满足局部Lipschitz 条件,同时设f (0)=0,对任意初始值x 0存在系统(2)的唯一解x (t )=x (t ,x 0)满足x (0,x 0)=x (0)㊂由李雅普诺夫第二法,如果存在一个正定函数V (x ),且它关于系统(2)的导数d V (x )/d t 是负定的,那么系统(3)的奇点x =0是渐近稳定的,系统(3)的奇点x =0的吸引域是所有具有性质lim t ңɕx (t ,x 0)=0的点的集合㊂如果吸引域是整个相空间R n ,则x =0是全局渐近稳定的㊂引理1[17](LaSalle-Yoshizawa 定理)㊀假设x =0是系统(2)的一个平衡点,同时f 在时间t 内关于x是局部Lipschitz 的㊂假设V (x ):R n ңR +是连续可微且正定的径向无界函数,使得V ㊃(x )ɤ-W (x )ɤ0(∀t ȡ0,x ɪR n )成立,其中W 为连续函数,那么系统(3)所有的解都是全局一致有界的,且满足lim t ңɕW (x (t ))=0,当W (x )正定时,系统全局渐近稳定且收敛于平衡点x =0㊂2㊀控制器设计与稳定性分析通常二自由度电动云台两个维度的方向分别由两个参数性能相同的同类型电机控制,所以俯仰轴与水平轴控制器设计完全一致,下面推导水平轴方向的控制器设计步骤㊂由原系统的非线性状态空间模型(2)可以看出,前2个状态方程是由式(1)中电机的机械特性方程转化得到,故称为机械子系统,控制器设计目标是使机械子系统的状态变量z 1和z 2跟踪预期轨迹,而对状态变量z 3无特别要求㊂结合反步法控制思想,可将原系统控制问题分解为若干个简单的子系统控制问题,进而逆向设计控制器㊂步骤1:根据实际跟踪控制目标,推导虚拟输入u ~㊂观察系统(2)中机械子系统的状态方程,可将其看做状态变量为z 1和z 2,控制输入为z 3的二阶系统,于是引入虚拟控制输入,记u ~=z 3,代入得到机械子系统的跟踪控制模型为51电㊀机㊀与㊀控㊀制㊀学㊀报㊀㊀㊀㊀㊀㊀㊀㊀㊀㊀㊀㊀㊀第27卷㊀z ㊃1=z 2;z ㊃2=k a J u ~-f Jz 2㊂}(4)针对机械子系统构造李雅普诺夫函数V sub =c 32(z 1-z ref 1)2+12(z 2-z ref 2)2㊂(5)式中c 3>0为待设计参数㊂取V sub 沿着子系统(3)轨迹的导数,有V ㊃sub =c 3(z 1-z ref 1)(z ㊃1-z ㊃ref1)+(z 2-z ref2)(z ㊃2-z ㊃ref2)=(z 2-z ref2)c 3(z 1-z ref1)+k a J u ~-f Jz 2-z ㊃ref 2[]㊂(6)据定义3,使V ㊃sub =-c 1(z 2-z ref 2)2<0,其中c 1>0为待设计参数,则需设计虚拟输入u ~=Jk af Jz 2+z ㊃ref 2-c 3(z 1-z ref 1)-c 1(z 2-z ref 2)[]㊂(7)步骤2:基于增广李雅普诺夫函数,设计实际输入u ㊂为保证步骤1中机械子系统的状态变量能够按照预期轨迹运行,需使得u ~=z 3,即z 3渐近稳定到u ~,故令e =z 3-u ~表示两者之间的偏差,设计一个增广的李雅普诺夫函数V aug =V sub+e 22㊂(8)取V aug 沿着整个系统(3)的轨迹导数,并结合式(8)有V ㊃aug =c 3(z 1-z ref 1)(z ㊃1-z ㊃ref1)+(z 2-z ref 2)(z ㊃2-z ㊃ref2)+e (z ㊃3-u ~㊃)=(z 2-z ref 2)c 3(z 1-z ref 1)+k a J(e +u ~)-[fJz 2-z ㊃ref 2]+e (z㊃3-u ~㊃)㊂(9)考虑系统状态空间模型(2)和式(8),将上式整理为V ㊃aug=(z 2-z ref2)c 3(z 1-z ref 1)+k a J u ~-f Jz 2-z ㊃ref 2)+[e (k a J (z 2-z ref 2)-b +z 1a Rz 3-z 2z 3b +z 1+b +z 1a u -u ~㊃]=-c 1(z 2-z ref 2)2+e (k a J(z 2-z ref2)-[b +z 1a Rz 3-z 2z 3b +z 1+b +z 1au -u ~㊃)]㊂(10)据定义3,对所有的z 1ʂz ref 1㊁z 2ʂz ref2及e ʂ0,欲使V ㊃aug =-c 1(z 2-z ref 2)2-c 2e 2<0,其中c 2>0为待设计参数,则需设计控制输入u 满足c 2e =k a J (z 2-z ref2)-b +z 1a Rz 3-z 2z 3b +z 1+b +z 1au -u ~㊃㊂(11)最终,得到电动云台系统的控制律u =a b +z 1[-c 2(z 3-u ~)-J (z 2-z ref2)+b +z 1a Rz 3+z 2z 3b +z 1+u ~㊃]㊂(12)式中:u ~=J k af J z2+z ㊃ref 2-c 3(z 1-z ref 1)-c 1(z 2-z ref 2)[];(13)标量c i >0(i =1,2,3))是待设计参数㊂根据水平轴电动云台模型(1),结合上述推导的控制器u 表达式(12)㊁式(13),有如下定理:定理1㊀考虑由系统(1)和控制律式(12)㊁式(13)组成的闭环动力学非线性系统,若存在正标量c i >0(i =1,2,3),且-c 1ʃc 21-4c 3<0,则对任意初始状态[z 1(t 0),z 2(t 0),z 3(t 0)]T ,都有[z 1(t ),z 2(t )]T 一致有界且满足lim t ңɕ[z 1(t ),z 2(t )]=[z ref1(t ),z ref2(t )],则系统(1)全局渐近稳定㊂证明:虚拟输入u ~的导数可以由式(13)表示为u ~㊃=Jk af J z㊃2+z ㊃㊃ref 2-c 3(z ㊃1-z ㊃ref 1)-c 1(z ㊃2-z ㊃ref 2)[]㊂(14)将式(12)㊁式(13)和式(14)代入式(9)可知,控制输入u 作用下的增广李雅普诺夫函数导数满足V ㊃aug =-c 1(z 2-z ref 2)2-c 2e 2ɤ0㊂(15)由定义3可知,从任意初始状态z 2(t 0)和i (t 0)都有lim t ңɕz 2=z ref2且lim t ңɕe =0,即随着时间推进,角速度z 2(t )会渐近跟踪预期轨迹z ref 2(t ),电流z 3则趋近于虚拟输入u ~㊂电动云台系统实现跟踪控制的主要标志为设备的角度和角速度变化量z =[z 1,z 2]T 与目标轨迹z ref 1(t )和z ref 2(t )相一致㊂因此,控制器设计还需使得lim t ңɕz 1=z ref 1,保证角速度跟踪目标轨迹㊂根据上述分析,经过一段时间后,电流z 3会趋近于虚拟输151第4期黄金杰等:二自由度云台非线性反步控制器设计入u ~,那么用虚拟输入表达式(13)替换电流z 3,原机械子系统的状态方程(4)简化为z ㊃1=z 2;z ㊃2=z㊃ref 2-c 3(z 1-z ref1)-c 1(z 2-z ref 2)㊂}(16)定义角度跟踪误差e z 1=z 1-z ref 1,e z 2=z 2-z ref2,则e z 2=e ㊃z 1,将其代入式(16)可得e㊃㊃z 1+c 1e ㊃z 1+c 3e z 1=0㊂(17)显然,如果c 1㊁c 3满足-c 1ʃc 21-4c 3<0㊂(18)则微分方程式(17)的特征方程的根都为负数,这意味着从任意初始状态z 1(t 0)开始,都有lim t ңɕz 1=z ref1㊂此时,很容易找到一个正定的连续函数W (x )=c 0(z 2-z ref 2)2+c 0e 2(c 0<c 1,c 0<c 2)满足lim t ңɕW (x (t ))=0并使V ㊃aug ɤ-W (x )成立,结合引理1可知,定理1成立㊂3 数值仿真与实例分析本文以电动云台拍摄系统(PTZ)远距离跟踪拍摄风电叶片表面图像为例[2],考察二自由度电动云台反步控制器的控制效果㊂在该系统中,长焦相机固定在电动云台上,远距离拍摄运行中的旋转风机叶片表面图像,长焦相机需在电动云台的控制下在跟随风电叶片旋转的同时沿着风电叶片的轴线方向运动以连续拍摄足够清晰的局部图像,然后通过局部图像拼接,获得风电叶片的完整图像,检测叶片表面是否发生损伤以及损伤情况[18]㊂系统中,电动云台期望的水平角位移轨迹为z ref 1p(t )=0.423sin(0.293t ),期望俯仰角位移轨迹z ref 1t (t )=-0.280cos(0.293t )+0.616,二者均为周期性变化的正弦信号㊂对于这样的参考输入信号,采用一般的鲁棒H ɕ控制器,总是存在一定的稳态跟踪偏差[18]㊂文献[12]进行了改进,增加了动态补偿控制,能渐近跟踪阶跃型参考信号,但对周期变化的信号效果不大,难以消除稳态跟踪误差㊂本文采用反步法设计控制器对电动云台进行控制㊂电动云台参数如下:a =14.96ˑ10-6N㊃m 2/A 2;b =4ˑ10-5m;电枢电阻R =2.270Ω;转矩常数k a =0.250N㊃m /A;转动惯量J =0.002kg㊃m 2;总摩擦系数f =0.001N㊃m /s㊂控制器参数c 1㊁c 2和c 3的选取需要保证是满足式(18)的正实数,选取初始值后根据经验法进行微调,结合实际仿真曲线的效果,如角速度跟踪时间尽可以快,可得到参数c 1=100,c 2=5000,c 3=100㊂由上述给定的云台参数及控制器参数,结合式(12)㊁式(13)和式(14)得到相应地控制器为u =u ~+1.1968ˑ10-74ˑ10-5+z 1z ref 1+0.06174ˑ10-5+z 1z ref2+6.1037ˑ10-44ˑ10-5+z 1z ㊃ref 2+1.1968ˑ10-74ˑ10-5+z 1z ㊃㊃ref 2㊂(19)式中u ~=-0.05984ˑ10-5+z 1z 1-0.06144ˑ10-5+z 1z 2+(2.27-0.07634ˑ10-5+z 1)z 3+0.06144ˑ10-5+z 1z 2z 3㊂结合上述期望水平角位移轨迹z ref1p (t )和期望俯仰角位移轨迹z ref1t (t )可得水平方向控制器和垂直方向控制器u 1和u 2分别为u 1=u ^+5.0625ˑ10-84ˑ10-5+z 1sin(2.093t )+0.05464ˑ10-5+z 1cos(2.093t )-0.00114ˑ10-5+z 1ˑsin(2.093t )-4.6416ˑ10-74ˑ10-5+z 1cos(2.093t );(20)u 2=u ^-3.3510ˑ10-84ˑ10-5+z 1cos(2.093t )+7.3722ˑ10-84ˑ10-5+z 1+0.03624ˑ10-5+z 1sin(2.093t )+7.4867ˑ10-44ˑ10-5+z 1cos(2.093t )-3.072ˑ10-74ˑ10-5+z 1sin(2.093t )㊂(21)取水平方向初态为z 1p (0)=-0.1,z ㊃1p (0)=0,z ㊃㊃1p(0)=0;俯仰方向初态z 1t (0)=0.2,z ㊃1t (0)=0,z ㊃㊃1t (0)=0㊂水平方向角位移轨迹跟踪如图1所示,在3.33s 后角位移跟踪误差减小到0.0041rad 以下,跟踪误差逐渐收敛至0;俯仰方向角位移跟踪如图2所示,角位移误差在3.54s 后减小到0.0041rad 以下,成功追踪上目标的角位移㊂水平方向和俯仰方向的角速度跟踪情况如图3㊁图4所251电㊀机㊀与㊀控㊀制㊀学㊀报㊀㊀㊀㊀㊀㊀㊀㊀㊀㊀㊀㊀㊀第27卷㊀示,分别在3.64s 和4.05s 后,角速度误差减小到了0.0025rad /s 以下,实现平滑跟踪㊂水平方向和俯仰方向共同运动追踪风机叶片上某一目标点时的整体跟踪效果如图5所示㊂水平方向和俯仰方向在给定的初始状态下开始跟踪期望轨迹,刚开始误差明显存在,经过4.05s 调整后PTZ 运动轨迹与目标点运动轨迹大致重合,证明了系统具有良好的跟踪效果㊂图1㊀水平角位移跟踪Fig.1㊀Pan angular displacementtracking图2㊀俯仰角位移跟踪Fig.2㊀Tilt angular displacementtracking图3㊀水平角速度跟踪Fig.3㊀Pan angular velocitytracking图4㊀俯仰角速度跟踪Fig.4㊀Tilt angular velocitytracking图5㊀云台角位移跟踪轨迹三维图Fig.5㊀3D diagram of the pan-tilt angular displacementtracking trajectory4㊀结㊀论本文针对一类二自由度电动云台的跟踪控制问题提出了一种非线性反步控制器设计方法㊂在建立了电动云台的非线性数学模型后,根据反步法的设计思想,先采用一般李雅普诺夫函数确定虚拟输入,然后利用增广李雅普诺夫函数设计系统控制律;进而,根据机械子系统的跟踪误差微分方程求解控制器参数范围;最后,结合LaSalle-Yoshizawa 定理证明系统全局渐近稳定㊂经数值实例表明,所提方法设计的反步控制器能够有效实现二自由度电动云台的轨迹对周期信号的跟踪控制㊂参考文献:[1]㊀CHEN Diansheng,PENG Zhaoliang,LING Xiao.A low-cost lo-calization system based on artificial landmarks with two degree of freedom platform camera[C]//International Conference on Robot-ics and Biomimetics (ROBIO 2014),December 5-10,2014,Bali,Indonesia.2015:625-630.[2]㊀高松.基于电动云台的风机叶片表面图像跟踪拍摄[D].哈351第4期黄金杰等:二自由度云台非线性反步控制器设计尔滨:哈尔滨理工大学,2021.[3]㊀HERVÉJ M.Uncoupled actuation of pan-tilt wrists[J].IEEETransactions on Robotics,2006,22(1):56.[4]㊀YOSAFAT S R,MACHBUB C,HIDAYAT E M I.Design andimplementation of pan-tilt control for face tracking[C]//20177th IEEE International Conference on System Engineering and Tech-nology(ICSET),October2-3,2017,Shah Alam,Malaysia.2017:217-222.[5]㊀RAMELAN A,SAPUTRO J S,APRIBOWO C H B,et al.Designand simulation linear quadratic gaussian(LQG)for pan-tilt face tracking camera servos[C]//AIP Conference Proceedings2217, 030073(2020).The5th International Conference on Industrial, Mechanical,Electrical and Chemical Engineering2019(ICIMECE 2019),2019,Surakarta,Indonesia.2020:2217(1):030073. [6]㊀肖杨,李俊辉,闻成.基于双环结构的视觉伺服云台控制器设计[J].计算机应用研究,2018,35(12):3743.XIAO Yang,LI Junhui,WEN Cheng.Visual servo platform con-troller design based on double-loop structure[J].Application Re-search of Computers,2018,35(12):3743.[7]㊀LENG X,WU S,DU Y,et al.Fuzzy sliding mode control forpan-tilt-zoom system driven by ultrasonic motor[C]//2015IEEE International Conference on Automation Science and Engineering (CASE),August24-28,2015,Gothenburg,Sweden.2015: 868-873.[8]㊀仇笑天.基于布谷鸟搜索的伺服云台控制器设计[J].自动化装置与设备,2021,43(3):80.CHOU Xiaotian.Design of a servo PTZ controller based on cuckoo search[J].Automation Devices&Equipments,2021,43(3):80.[9]㊀BENOSMAN M,ATINÇG M.Nonlinear learning-based adaptivecontrol for electromagnetic actuators[C]//2013European Control Conference(ECC),July17-19,2013,Zurich,Switzerland.2013:2904-2909.[10]㊀刘燕斌,陆宇平.基于反步法的高超音速飞机纵向逆飞行控制[J].控制与决策,2007,1(3):313.LIU Yanbin,LU Yuping.Longitudinal inversion flight controlbased on backstepping for hypersonic vehicle[J].Control andDecision,2007,1(3):313.[11]㊀HUANG Jinjie,PAN Xiaozhen,HAO Xianzhi.Event-triggerednetworked Hɕoutput tracking control based on dynamic compen-sation controller[J].International Journal of Control,Automa-tion and Systems,2021,19(10):3318.[12]㊀CHEN Salle-Yoshizawa theorem for nonlinear systemswith external inputs:A counter-example[J].Automatica,2022:110636.[13]㊀吕德刚,姜国威,纪堂龙.永磁同步电机低速域改进高频脉振注入控制[J].哈尔滨理工大学学报,2022,27(6):32.LÜDegang,JIANG Guowei,JI Tanglong.Improved high fre-quency pulse injection control inlow speed domain of permanentmagnet synchronous motor[J].Journal of Harbin University ofScience and Technology,2022,27(6):32.[14]㊀何丹华,郭庆义,蒲志林.一类半线性合作椭圆系统在无界区域上的径向对称解[J].四川大学学报(自然科学版),2009,46(6):1611.HE Danhua,GUO Qingyi,PU Zhilin.Radially symmetric solu-tions of a semilinear cooperative system on the unbounded domain[J].Journal of Sichuan University(Natural Science Edition),2009,46(6):1611.[15]㊀USA Humphries,Grienggrai Rajchakit,Pramet Kaewmesri,etal.Global stability analysis of fractional-order quaternion-valuedbidirectional associative memory neural networks[J].Mathemat-ics,2020,8(5):801.[16]㊀BENOSMAN M.Learning-based adaptive control:an extremumseeking approach-theory and applications[M].Butterworth-Heinemann,2016:10.[17]㊀FISCHER N,KAMALAPURKAR R,DIXON W Salle-Yo-shizawa corollaries for nonsmooth systems[J].IEEE Transac-tions on Automatic Control,2013,58(9):2333. [18]㊀岳欣华,邓彩霞,张兆茹.BP神经网络与形态学融合的边缘检测算法[J].哈尔滨理工大学学报,2021,26(5):83.YUE Xinhua,DENG Caixia,ZHANG Zhaoru.BP neural net-work fuse with morphology edge detection method[J].Journal ofHarbin University of Science and Technology,2021,26(5):83.(编辑:刘素菊)451电㊀机㊀与㊀控㊀制㊀学㊀报㊀㊀㊀㊀㊀㊀㊀㊀㊀㊀㊀㊀㊀第27卷㊀。
二自由度PID
• • • • • • •
二自由度PID控制器优化设计 仪器仪表学报 一种二自由度PID控制器参数整定方法 清华大学学报(自然科学版) 一种基于粒子群算法的2DOF-PID控制器优化设计 机械设计与制造 神经元二自由度PID控制器参数的MATLAB优化 福州大学学报 一种基于模糊逻辑的二自由度PID的实现 太原理工大学学报 PID控制器参数整定方法及其应用研究 浙江大学硕士学位论文 基于遗传算法的系统建模与PID控制方法研究 武汉大学硕士学位论文 实际应用研究 • 二自由度PID的一种工程实现 西安科技大学学报 • 基于PLC的二自由度PID控制算法研究及应用 计算机测量与控制 • 交流永磁同步电机二自由度PID控制 电气传动
传统PID与二自由度PID仿真结果对比图
谢谢
二、2DOF-PID特点
1、在式(4)的传递函数中有一项Ga,从式(1)可知,Ga是一个 以 λ为可变参数的滤波器, 该滤波器有以下两个作用: ①具有低通滤波的效果。λ值的取值范围是0~1,当λ值逐渐 增大时, 滤波器的低通滤波特性将越来越强,当λ=1时目标滤波 器的传递函数变成 ,这是一个典型的一阶惯性环节,即 是一个典型的低通滤波器。 ②具有抑制超调的特性。随着λ值增大,其抑制超调的作用 将越加明显,假设某一控制对象为二阶系统 ,T1、 T2的值约为20~ 30s,P= 10%,I= 15s,d= 0。在不同λ值时 对给定值的阶跃响应过渡过程曲线下图所示。
《二自由度PID的一种工程实现》采用可编程调节器实现二 自由度PID控制。根据控制组态图编程,在整定好抑制扰动为 最佳的情况下,进行设定值发生变化和抗扰动性能试验。下图 是常规PID控制和二自由度PID控制时系统的跟随特性和抗扰动 特性曲线对比图,图中“O”和“*”分别表示常规PID控制和 二自由度PID控制的响应曲线。可看出用二自由度PID控制能够 满足系统的“抗扰性能最佳”(右图)和“跟随性能最佳”(左图), 优于常规PID控制。
二自由度运动控制系统
二自由度运动控制系统KNT-PHT2预习报告班级:自动化4班学号:201132010417姓名:罗滨一、实验目的1.掌握二自由度运动控制系统实训装置的基本组成2.掌握设备基本部件的作用二、实验设备1.二自由度运动控制系统实训装置2.AC 220V 电源三、KNT-PHT2 实训装置的基本构成及特点1、二自由度运动控制系统在理解和掌握气动应用和位置控制原理的基础上,利用PLC 或其他控制器实现对其控制,利用设备控制面板上的模式旋钮来选择自动/手动的运行方式,该实训装置主要由二维画笔和电控系统两大部分所组成。
(1)、二维画笔二维画笔由二维十字滑台、工作台、画笔台、控制盒及实训桌等组成。
a 二维十字滑台结构:二维十字滑台主要X 轴滚珠丝杠副运动机构和Y 轴滚珠丝杠副运动机构所组成。
Y 轴滚珠丝杠副运动机构是直接安装在实训桌面的,X 轴滚珠丝杠副运动机构是安装在Y 轴滚珠丝杠副运动机构的滑块上面的,这样X 轴滚珠丝杠副运动机构、Y 轴滚珠丝杠副运动机构就组合成了一个二维十字滑台滚珠丝杠副运动机构:滚珠丝杠副运动机构由前后支撑块、驱动电机(伺服电机)及支架、导柱、滑块、滚珠丝杠副以及磁簧开关等器件构成。
其中,滚珠丝杠副运动机构由前后支撑块、驱动电机(伺服电机)及支架、导柱、滑块、滚珠丝杠副以及磁簧开关等器件构成。
特点:当驱动电机转动时,由于电机轴与滚珠丝杠副运动机构的滚珠丝杠副通过弹性联轴器连接,所以滚珠丝杠与电机同步转动,而装在滚珠丝杠副上面的螺母块是与滑块位固定在一起的,螺母块会随着滚珠丝杠副的正反转动做左右运动,所以滑块沿着两根导柱做直线运动。
此外,滚珠丝杠副运动机构的原点位置是用磁簧开关检测定位的,并在两端的极限位置上安装了硬限位开关(磁簧开关),可有效防止由于运行超程而引起的机械或电气设备的损坏。
该运动机构具有行走阻力小、运行平稳、精度高等特点,通过伺服电机驱动,可以实现高精度的定位控制和比较复杂的轨迹运动控制。
a69_二自由度云台控制器设计方案
电子工业出版社《EDA应用技术》编制王真富
« » ___
项目8二自由度云台控制器设计方案
任务描述
用FPGA最小系统板设计控制器,实现对二自由度舵机云台的精确控制, 设计要求: 在Quartus II 13. 0软件平台上,用VHDL程序设计矩阵式键 盘控制电路、数码 管动态显示电路、舵机控制电路;用ModelSimAltera 10. 5b仿真软件仿真检查设 计结果;选用FPGA最小系统板、2自 由度舵机云台、矩阵式键盘、数码管等硬件资源 进行硬件验证。
A<HZZk
BCHZZF
C 0—1 h
DE O0-~C~IZ卜F
FO-CZIG0—
PO-CD
300
FPGA的输入输出引脚资源。 所谓
动态扫描是指每个数码管不 是一
直显示, 而是每隔一定时间 显示一 次, 只要间隔时间足够短, 由于人 眼的视觉暂留现象, 在视 觉上是一 直显示的。动态扫描数
码管的原理图, 如图8. 5所示。
PWM控制信号要求可知, 脉宽度计数器长度cnt=25000+nX [(2X106)/1801/20, 其中n值为
旋转的角度值。部分脉冲宽度与舵机转动角度及脉宽度计数器长度的关系如 表8. 2所示,
其它角度可根据脉宽与角度改变呈线性变化计算。
表S.2脉冲宽度与舵机转动角度及脉宽度计数器长度的关系
转动角度 0 45 90 135 ISO
电子工业出版社《EDA应用技术》编制王真富
A
X ©公
t
23 A
5|! 61,1 曰1
1L
8Il曰J F E |l
°;
C| | . □f
*
dM |
ITTTII
二自由度机器人的通用控制
二自由度机器人的通用控制机器人是一中自动化的机器,所不同的是这种机器具备一些与人或生物相似的智力能力,如感知能力,规划能力,动作能力和协同能力,是一中具有高度灵敏的自动化机器。
作为一个复杂的综合系统,机器人控制系统涉及到很多的学科(如计算机,机械,传感器,人工智能等)。
其中,机器人的控制系统具有很重要的意义。
随着机器人的功能日益复杂,如何综合考虑模块功能,控制性能要求,设计一个合乎要求的机器人控制系统,将是一项非常有意义的事情。
那么研究一个机器人控制系统,需要我们对机器人控制系统有一个明确的认识。
机器人控制体系是指控制机器人的软件和硬件机构,其研究主要集中在机器人控制器的研究和开发上,通常分为功能设计和结构设计。
功能设计部分要完成控制功能和算法的定义,结构设计是完成功能在软件和硬件上的分布。
本文概要本文主要着眼于机器人的控制系统的设计。
以二连杆机器人的控制系统为例提出二自由度机器人的控制设计方案:基于PID 控制器的二自由度机器人的MATLAE仿真。
第一章:机器人的基础知识什么是机器人?如果将常规的机器人操作手与挂在多用车或着牵引车上的起重机进行比较,可发现两者非常相似。
他们都具有许多的连杆,这些关节同过连杆依次连接,这些关节有驱动器驱动。
在上述两个系统中,操作手都能在空中运动并且还可以运动到空间的任何位置,他们都能承担一定的负荷,并都用一个中央控制器驱动器。
然而,他们一个称为机器人一个称为起重机,两者最根本的不同就是起重机是有人工操作的,而机器人是由计算机编程控制的,正是通过这个可以区别一台设备到底是简单的操作机还是机器人。
通常机器人设计成由计算机或着类似的装置来控制,机器人的动作受计算机监控的控制器多控制,该控制器本身也会运行某中类型的程序。
因此,如果程序变了,机器人的动作相应的就会改变。
我们希望一台设备能灵活地完成各种不同的工作而无需要重新设计硬件装置。
为此机器人必须设计成可重复编程,通过改变程序来执行不同的任务(当然在限制的范围内)。
采用双自由度PI速度控制器的PMSM矢量控制仿真研究
Ke wors:M SM,e o o r , y d P v ctr c nt TDF Co r , ol PI nt MATL ol AB/ m uik si l n
其 中 为转 子永 磁 体 磁 链 的值 , 于 特定 的永 磁 同步 电机 对
为 一 常数 ;
定 子 绕 组 产生 的 电磁 转 矩表 达 式 为 :
men orco v t n PI onr lca tbe tF n eni al c to n no me h rqui mens wh h oors ed n l d or e sep ch g ta o t te e r e t en t e m t pe a d oa t qu t an e h t d a i rs ns c r s fm oors e o erh ota d pe e v r ae h or yn m c e po e uve o t pe d v s o n s ed r co ey r s a t
张 成 王 富 东 罗 力恒 李 盛 宁 杨 丹 明 ( 苏州大学机 电工程学院, 江苏 苏州 2 5 2 ) 1 0 1
摘 要
分 析 了永磁 同步 电机 的 数 学模 型 。 用 励磁 电流 i 0的转 子磁 场 定 向 矢量控 制 方 法 , Ma l / i l k环境 下构 建 采 d = 在 t b Smu n a i 了永磁 同步 电机 ( MS 矢量控 制 仿 真模 型 。针 对 常 规 P 控 制 无 法 满足 当电机 转 速 和 负栽 转 矩发 生阶 跃 变 化 时 , P M) J 电机 动 态响应 曲线 中转 速 超 调量 小和 转 速恢 复施 加短 的要 求 , 出 了一种 双 自由度 P 速 度 控 制 方 法 。 真结 果 表 明 , 提 I 仿 该控 制 方 法 符 合理 论 分析 , 具有 良好 的 动 态性 能 。 关键词: 永磁 同步 电机 , 量控 制 , 自由度 P 控 制 , T A / i l k 真 矢 双 I MA L B S i 仿 mun
- 1、下载文档前请自行甄别文档内容的完整性,平台不提供额外的编辑、内容补充、找答案等附加服务。
- 2、"仅部分预览"的文档,不可在线预览部分如存在完整性等问题,可反馈申请退款(可完整预览的文档不适用该条件!)。
- 3、如文档侵犯您的权益,请联系客服反馈,我们会尽快为您处理(人工客服工作时间:9:00-18:30)。
第一章绪论在工程和科学技术发展过程中,自动控制担负着重要的角色。
除了在宇宙飞船系统、导弹制导系统和机器人系统等领域中,自动控制具有特别重要的作用之外,它已成为现代机器制造业和工业生产过程中的重要而不可缺少的组成部分。
例如,在制造工业的数控机床控制中,在航空和航天工业的自动驾驶仪系统设计中,以及在汽车工业的小汽车和大卡车设计中,自动控制都是必不可少的。
此外,在工业中的过程控制,对压力、温度、湿度、黏性和流量的控制等工业操作过程,自动控制也是不可缺少的。
自动控制理论和实践的不断发展,为人们提供了获得动态系统最佳性能的方法,提高了生产率,并且使人们从繁重的体力劳动和大量重复性的手工操作中解放出来。
1.2控制系统的分类1.2.1 反馈控制系统能对输出量与参考输入量进行比较,并且将它们的偏差作为控制手段,以保持两者之间预定关系的系统,称为反馈控制系统。
室温控制系统就是反馈系统的例子。
通过实际室温,并且将其与参考温度(希望的室温)进行比较,温室调机器就会按照某种方式,加温或冷却设备打开或关闭,从而将室温保持在使人们感到舒适的水平上,且与外界条件无关。
反馈系统并不限于工程系统,在各种不同的非工程领域,同样存在着反馈控制系统。
1.2.2 闭环控制系统反馈控制系统通常属于闭环控制系统。
在实践中,反馈控制和闭环控制这两个术语通常交换使用。
在闭环控制系统中,作为输入信号与反馈信号(反馈信号可以是输出信号本身,也可以是输出信号的函数及其导数和/或其积分)之差的作用误差信号被传送到控制器,以便减小误差,并且使系统的输出达到希望的值。
闭环控制这个术语,总是意味着采用反馈控制作用,以减小系统误差。
1.2.3 开环控制系统系统的输出量对控制作用没有影响的系统,称为开环控制系统。
换句话说,在开环控制系统中,既不需要对输出量进行测量,也不需要将输出量反馈到系统的输入端与输入端进行比较。
在任何开环控制系统中,均无需将输出量与参考输入量进行比较。
因此,对应于每一个参考输入两,有一个固定的工作状态与之对应。
这样,系统的精确度便取决于标定的精确度。
当出现扰动时,开环系统便不能完成既定任务了。
在实践中,只有当输入量与输出量之间的关系一直,并且不出在内部扰动,也不存在外部扰动的时候,才能用开环控制系统。
1.2.4 控制系统比较闭环控制系统的优点是采用了反馈,因而使系统的响应对外部干扰和内部系统的参数变化均相当不敏感。
这样,对于给定的控制对象,有可能采用不太精密且成本较低的元件构成精确的控制系统。
在开发情况下,就不可能做到这一点。
从稳定性的观点出发,开环控制系统比较容易建造,因而对开环系统来说,稳定性不是主要问题。
但是另一方面,在闭环控制系统中,稳定性则始终是一个重要的问题,因为闭环系统可能引起过调误差,从而导致系统进行等幅振荡或变幅振荡。
应当强调指出,当系统的输入量能预先知道,并且不存在任何扰动时,采用开环控制比较合适。
只有当存在着无法预计的扰动和(或)系统中的元件的参数存在着无法预计的变化时,闭环控制系统才具有优越性。
还应指出,系统输出功率的大小在某种程度上确定了控制系统的成本,重量和尺寸。
闭环控制系统采用的元件数量比相应的开环控制系统要多,因此闭环控制系统的成本和功率通常比较高。
为了减小系统所需要的功率,在可能的情况下,应当采用开环控制系统。
将开环控制与闭环控制适当的结合在一起,通常比较经济,并且能够或得满意的综合系统性能。
1.3 自动控制器简介自动控制器将被控对象输出量的实际值与参考输入量(要求的值)进行比较,确定出偏差,并产生控制信号,以便使偏差减小到零或很小的值。
自动控制器产生控制信号的方式,称为控制作用。
图1.1 工业控制系统框图如图是一种工业控制系统方块图,它是由自动控制器、执行器、被控对象和传感器(测量元件)组成的。
控制器检测出功率通常很低的作用误差信号,并且将其放大到足够高的水平。
自动控制器的输出传送至执行器,例如传送至电动机、液压马达、气动马达或阀。
(执行器是一种动力装置,它根据控制信号的要求,产生被控对象的输入量,从而使输出信号趋于参考输入信号。
)传感器或测量元件,是一种将输出变量转变为另一种适当变量的装置,这里所说的适当变量如位移、压力或电压,可以用来将输出量与参考输入信号进行比较。
这种元件位于闭环系统的反馈通达上。
控制器的设定值必须转变为参考输入量,并且应具有与来自传感器或测量元件的反馈信号相同的单位1.4现代控制理论简介工程系统正朝着更加复杂的方向发展,这主要是由于复杂的任务和高精度的要求所引起的。
复杂系统可能具有多输入量和多输出量,并且可能是时变的。
由于需要满足控制系统性能提出的日益严格的要求,系统的复杂程度越来越大,并且要求能够方便地用大型计算机对系统进行处理。
一种对复杂控制系统进行分析和设计的新方法,即现代控制理论,大约从1960年开始发展起来。
这种新方法是建立在状态概念之上的。
状态本身并不是一个新概念,在很长一段时间内,它已经存在于古典动力学和其他一些领域中。
现代控制理论是建立在状态空间法基础上的一种控制理论,是自动控制理论的一个主要组成部分。
在现代控制理论中,对控制系统的分析和设计主要是通过对系统的状态变量的描述来进行的,基本的方法是时间域方法。
现代控制理论比经典控制理论所能处理的控制问题要广泛得多,包括线性系统和非线性系统,定常系统和时变系统,单变量系统和多变量系统。
它所采用的方法和算法也更适合于在数字计算机上进行。
现代控制理论还为设计和构造具有指定的性能指标的最优控制系统提供了可能性。
现代控制理论的名称是在1960年以后开始出现的,用以区别当时已经相当成熟并在后来被称为经典控制理论的那些方法。
现代控制理论已在航空航天技术、军事技术、通信系统、生产过程等方面得到广泛的应用。
现代控制理论的某些概念和方法,还被应用于人口控制、交通管理、生态系统、经济系统等的研究中[1]。
1.4.1 现代控制理论发展过程现代控制理论是在20世纪50年代中期迅速兴起的空间技术的推动下发展起来的。
空间技术的发展迫切要求建立新的控制原理,以解决诸如把宇宙火箭和人造卫星用最少燃料或最短时间准确地发射到预定轨道一类的控制问题。
这类控制问题十分复杂,采用经典控制理论难以解决。
1958年,苏联科学家Л.С.庞特里亚金提出了名为极大值原理的综合控制系统的新方法。
在这之前,美国学者R.贝尔曼于1954年创立了动态规划,并在1956年应用于控制过程。
他们的研究成果解决了空间技术中出现的复杂控制问题,并开拓了控制理论中最优控制理论这一新的领域。
1960~1961年,美国学者R.E.卡尔曼和R.S.布什建立了卡尔曼-布什滤波理论,因而有可能有效地考虑控制问题中所存在的随机噪声的影响,把控制理论的研究范围扩大,包括了更为复杂的控制问题。
几乎在同一时期内,贝尔曼、卡尔曼等人把状态空间法系统地引入控制理论中。
状态空间法对揭示和认识控制系统的许多重要特性具有关键的作用。
其中能控性和能观测性尤为重要,成为控制理论两个最基本的概念。
到60年代初,一套以状态空间法、极大值原理、动态规划、卡尔曼-布什滤波为基础的分析和设计控制系统的新的原理和方法已经确立,这标志着现代控制理论的形成。
1.4.2 现代控制理论的学科内容现代控制理论所包含的学科内容十分广泛,主要的方面有:线性系统理论、非线性系统理论、最优控制理论、随机控制理论和适应控制理论。
线性系统理论它是现代控制理论中最为基本和比较成熟的一个分支,着重于研究线性系统中状态的控制和观测问题,其基本的分析和综合方法是状态空间法。
按所采用的数学工具,线性系统理论通常分成为三个学派:基于几何概念和方法的几何理论,代表人物是W.M.旺纳姆;基于抽象代数方法的代数理论,代表人物是R.E.卡尔曼;基于复变量方法的频域理论,代表人物是H.H.罗森布罗克。
非线性系统理论非线性系统的分析和综合理论尚不完善。
研究领域主要还限于系统的运动稳定性、双线性系统的控制和观测问题、非线性反馈问题等。
更一般的非线性系统理论还有待建立。
从70年代中期以来,由微分几何理论得出的某些方法对分析某些类型的非线性系统提供了有力的理论工具。
最优控制理论最优控制理论是设计最优控制系统的理论基础,主要研究受控系统在指定性能指标实现最优时的控制规律及其综合方法。
在最优控制理论中,用于综合最优控制系统的主要方法有极大值原理和动态规划。
最优控制理论的研究范围正在不断扩大,诸如大系统的最优控制、分布参数系统的最优控制等。
随机控制理论随机控制理论的目标是解决随机控制系统的分析和综合问题。
维纳滤波理论和卡尔曼-布什滤波理论是随机控制理论的基础之一。
随机控制理论的一个主要组成部分是随机最优控制,这类随机控制问题的求解有赖于动态规划的概念和方法。
适应控制理论适应控制系统是在模仿生物适应能力的思想基础上建立的一类可自动调整本身特性的控制系统。
适应控制系统的研究常可归结为如下的三个基本问题:①识别受控对象的动态特性;②在识别对象的基础上选择决策;③在决策的基础上做出反应或动作。
1.4.3 现代控制理论与传统控制理论的比较现代控制理论与窗同控制理论形成鲜明的对照,前者适用于多输入、多输出系统,系统可以是线形的或非线形的,也可以是定常的或时变的;后者则仅仅适用于线形、定常、单输入、单输出系统。
此外,现代控制理论本质上是一种时域方法,而传统控制理论则是一种复频域方法。
1.2小结本章对控制系统以及控制器做了简单的介绍,了解了控制系统在当今社会的重要作用,同时也对不同的控制系统有了了解。
对于控制器的介绍,则使我们从宏观来到了微观,真正明白了控制系统的工作原理。
现代控制理论的引入则为控制系统的更好发展做好了条件。
在现代控制理论的指导下,控制系统将会发展的更加完善。
第二章双自由度控制器2.1引言在自动控制系统的设计过程中,目标值跟踪特性和外扰抑制特性是设计者关注两个主要问题。
在过去的控制中,定值系统强调外扰抑制特性,随动系统强调目标值跟踪特性,两种特性均要求十分严格的场合比较少见。
但是随着高新技术的发展和应用,对自动控制系统的要求越来越高,同时要求目标值跟踪特性和外扰抑制特性最佳的系统愈来愈多。
而目前在工业控制中广泛采用的PID调节器只能设定一组控制参数,(称一自由度控制方式,控制器结构图如图1所示)一般来讲,若按干扰抑制特性最优来整定参数,则目标值跟踪特性差;若按目标值跟踪特性最优来整定参数,则干扰抑制特性差,所以PID调节器的参数整定通采用折衷的方法。
这样做一般能满足大多数控制系统的要求,但对于高性能系统则难以达到控制系统的期望特性。
针对这一问题,国内外学者提出二自由度控制的思想,其控制结构如图2所示。
图1一自由度控制器结构图图2二自由度控制嚣结构图2.2 双自由度控制所谓二自由度控制一般说来是指:采用图2这种控制系统结构,将控制器c分解,采用适当的设计方法,找到两组独立的参数并设计出两个独立的控制器,分别用来获得最优的目标跟踪值特性和干扰抑制特性,从而达到控制系统的期望特性。