CN114859708A - 一种单连杆柔性机械臂跟踪控制方法 - Google Patents
一种单连杆柔性机械臂跟踪控制方法 Download PDFInfo
- Publication number
- CN114859708A CN114859708A CN202210277091.8A CN202210277091A CN114859708A CN 114859708 A CN114859708 A CN 114859708A CN 202210277091 A CN202210277091 A CN 202210277091A CN 114859708 A CN114859708 A CN 114859708A
- Authority
- CN
- China
- Prior art keywords
- mechanical arm
- flexible mechanical
- constraint
- tracking
- link flexible
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Pending
Links
Images
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B13/00—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion
- G05B13/02—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric
- G05B13/04—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators
- G05B13/042—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators in which a parameter or coefficient is automatically adjusted to optimise the performance
-
- Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02P—CLIMATE CHANGE MITIGATION TECHNOLOGIES IN THE PRODUCTION OR PROCESSING OF GOODS
- Y02P90/00—Enabling technologies with a potential contribution to greenhouse gas [GHG] emissions mitigation
- Y02P90/02—Total factory control, e.g. smart factories, flexible manufacturing systems [FMS] or integrated manufacturing systems [IMS]
Abstract
一种单连杆柔性机械臂跟踪控制方法,涉及一种机械臂跟踪控制方法,本发明为一种针对非对称时变全状态约束下的单连杆柔性机械臂轨迹跟踪控制方法,通过直流电动机控制的单连杆柔性机械臂系统的动力学模型,通过选择合适的状态以及对未知有界扰动和跟踪轨线进行合适的约束,在实际控制器的设计中,将反步法应用于自适应模糊实际控制器的设计中,为了防止约束越界,本发明在反步法设计的每一步中同时还引入了新的tan型非对称时变阻碍李雅普诺夫函数,设计相应的控制律和自适应律,保证无论初始条件如何,实现最终一致有界的跟踪控制效果,而且不对称时变约束可以在有限时间之后实现。
Description
技术领域
本发明涉及一种机械臂跟踪控制方法,特别是涉及一种针对带有输出非对称时变约束的单连杆柔性机械臂的跟踪控制方法。
背景技术
随着社会生产力的迅速发展,机械臂在各个领域内的应用越来 越广泛,尤其是航空航天、服务等领域,机械臂的研究越来越受重视.与刚性机械臂相比,单连杆柔性机械臂自重轻、耗能低、灵活度高,具有明显的优势,所以单连杆柔性柔性柔性机械臂的研究也成为了一个热点.
机器人在现代工业自动化生产中越来越多地得到应用,成为了工业生产体系中的重要角色。作为机器人的一种,工业机械臂可以代替人类从事一些装配、搬运和焊接等重复高强度或高精度要求的工作。和人工相比,工业机械臂拥有更高的工作效率,并且可以在一些危险的环境下进行工作,可以有效提升工厂的生产力水平。
面对越来越复杂的生产工艺,对工业机械臂的控制要求也不断提升,如何对工业机械臂进行有效控制,一直是热门研究方向,近年来取得了不少研究成果。在一些需要与人进行交互或高精度的工作任务中,为了确保生产安全和控制精度,需要对机械臂的运动空间、运动速度以及跟踪误差进行限制。因此,对机械臂的约束控制进行研究具有重要的实际意义。
但是,单连杆柔性机械臂的自身结构与材料所具有的优点也是其研究困扰所在.在运动过程中,单连杆柔性机械臂自身会产生弹性形变与模糊,这就使得其运动定位 与轨迹跟踪有一定难度,因此,对单连杆柔性机械臂的运动轨迹实现跟踪并对其模糊进行抑制有重要意义.此外,在运动控制中常遇到约束问题,比如驱动电动机的额定转矩、额定转速、机械限位、运动干涉等,还有一些特定场合中的特殊约束问题,如绳牵引机构在运动中需要考虑 绳子的牵引力约束机械加工中需要通过优化刀具运动轨迹使切 削力满足约束、视觉伺服系统需要考虑视觉的能见性约束、移动小车在转弯过程中需要考虑曲率约束、刚性机器人的运动中需要对各个关节的角速度和角度进行约束。
现有技术研究了带有输出约束的不确定欠驱动水面船舶的自适应神经网络轨迹跟踪控制问题。同时现有技术研究了带有输出约束和输入死区的机械臂系统的自适应神经网络跟踪控制。然而,现有技术还不能解决带有输出非对称时变约束的单连杆柔性机械臂的跟踪控制问题,这些新的技术尚待提出。
发明内容
本发明的目的在于提供一种单连杆柔性机械臂跟踪控制方法,本发明为一种针对非对称时变全状态约束下的单连杆柔性机械臂轨迹跟踪控制方法,该方法在己有的约束条件下,保证无论初始条件如何,都可实现最终一致有界的跟踪控制效果。通过直流电动机控制的单连杆柔性机械臂系统的动力学模型,在实际控制器的设计中,将反步法应用于自适应模糊实际控制器的设计中,实现最终一致有界的跟踪控制效果,解决了有限维模型描述单连杆柔性机械臂系统模型,导致单连杆柔性机械臂系统不稳定的问题。
本发明的目的是通过以下技术方案实现的:
一种单连杆柔性机械臂跟踪控制方法,所述方法建立直流电动机控制的单连杆柔性机械臂系统的动力学模型;根据实际的要求所述的针对带有输出非对称时变约束的单连杆柔性机械臂的跟踪控制方法,包括以下步骤:
步骤一:
建立单连杆柔性机械臂系统的动力学模型,包括单连杆柔性机械臂系统的控制方程及单连杆柔性机械臂末端角位移的运动方程;
其中,
是电机转子惯性,是连杆质量,是负载质量,是连杆长度,是负载半径,是重力加速度,是粘滞摩擦系数;代表电机角位移(同时也是机械臂关节角度),代表电机电枢电流,是转矩系数,是电枢电感,是电枢电阻,是反电动势系数,代表输人控制电压;
步骤二:
步骤三:将实际控制器应用于单连杆柔性机械臂的控制,设计非对称时变约束区间,对单连杆柔性机械臂的转角、转动速度和转矩进行约束控制;
步骤四:依据动力学模型,确定带有输出约束的实际控制器,对带有输出约束的单连杆柔性机械臂的模糊进行抑制的同时,控制单连杆柔性机械臂转动到期望角位置之后,通过李雅普诺夫直接法对实际控制器进行稳定性分析;
步骤五:通过李雅普诺夫直接法对所述实际控制器进行稳定性分析之后,并通过仿真验证实际控制器的可行性及有效性。
所述的一种单连杆柔性机械臂跟踪控制方法,所述步骤三约束控制的控制目标为:
(1)闭环系统中全部信号都是有界的;
所述的一种单连杆柔性机械臂跟踪控制方法,所述针对带有输出非对称时变约束的单连杆柔性机械臂的跟踪控制方法,实际控制器表示为:
虚拟控制器为:
自适应率:
所述的一种单连杆柔性机械臂跟踪控制方法,所述带有输出非对称时变约束的单连杆柔性机械臂的跟踪控制方法,该方法通过李雅普诺夫直接法对实际控制器进行稳定性分析,包括构造针对单连杆柔性机械臂的闭环系统的李雅普诺夫候选函数若李雅普诺夫候选函数是正定的,且李雅普诺夫候选函数对时间的导数半负定,则判定实际控制器能使单连杆柔性机械臂的闭环系统渐进稳定。
本发明的优点与效果是:
本发明为一种针对非对称时变全状态约束下的单连杆柔性机械臂轨迹跟踪控制方法,该方法在己有的约束条件下,保证无论初始条件如何,都可实现最终一致有界的跟踪控制效果。通过直流电动机控制的单连杆柔性机械臂系统的动力学模型,通过选择合适的状态以及对未知有界扰动和跟踪轨线进行合适的约束, 在实际控制器的设计中,将反步法应用于自适应模糊实际控制器的设计中,为了防止约束越界,本发明在反步法设计的每一步中同时还引入了新的tan型非对称时变阻碍李雅普诺夫函数,设计相应的控制律和自适应律,保证无论初始条件如何,实现最终一致有界的跟踪控制效果,而且不对称时变约束可以在有限时间之后实现。本发明广泛适用于自动控制领域。
本发明自适应跟踪控制器可以让单连杆柔性机械臂具有良好的跟踪性能,并且系统输出可以保持在非对称时变约束区间内,满足约束条件。从仿真结果可知,本发明非对称时变约束控制方法可以有效对单连杆柔性机械臂进行控制,并对机械臂的转角、转动速度和转矩进行非对称时变约束,同时减少了单连杆柔性机械臂趋于稳定的时间。
附图说明
图1为本发明单连杆柔性机械臂立体图;
图2为本发明直流电动机控制单连杆柔性机械臂原理图;
图3为本发明设计原理流程图;
具体实施方式
下面结合附图所示实施例对本发明进行详细说明。
步骤一:一种针对非对称时变全状态约束下的单连杆柔性机械臂轨迹跟踪控制方法,包括:建立直流电动机控制的单连杆柔性机械臂系统的动力学模型;
根据实际的要求所述的针对带有输出非对称时变约束的单连杆柔性机械臂的跟踪控制方法,其单杆机械臂系统的动力学模型包括单连杆柔性机械臂系统的控制方程及单连杆柔性机械臂末端角位移的运动方程。
其中,
是电机转子惯性,是连杆质量,是负载质量,是连杆长度,是负载半径,是重力加速度,是粘滞摩擦系数。代表电机角位移(同时也是负载位移),代表电机电枢电流,是转矩系数,是电枢电感,是电枢电阻,是反电动势系数,代表输人控制电压。
步骤二: 将建立的动力学模型转化成状态方程;
步骤三:将本发明所设计实际控制器应用于单连杆柔性机械臂的控制,设计了非对称时变非对称约束区间,对单连杆柔性机械臂的转角、转动速度和转矩进行约束控制。
本发明控制目标:
(1)闭环系统中全部信号都是有界的;
步骤四:对控制器进行设计,需要定义如下跟踪误差
跟踪误差的一阶导数如下
为了对系统(2)的全部状态进行非对称时变约束,按照如下形式选取非对称时变阻碍李雅普诺夫函数为
计算(5)的导数可得
实际控制器表示为
其中
虚拟控制器为:
自适应率:
步骤五:验证单连杆柔性机械臂系统的稳定性分析
对于系统(2)所示带有全状态非对称时变约束的单连杆柔性机械臂系统,通过选择合适的设计参数,设计系统的实际控制器(8)、虚拟控制器(9)和自适应率(10),当系统初始条件满足时,可以使得如下控制目标成立:
(1)单连杆柔性机械臂系统中全部信号都是有界的;
证明:为了便于表示,定义如下参数
证明完毕。
步骤六:仿真结果分析
本发明利用Matlab软件设计两个仿真程序用以验证本发明设计的自适应跟踪控制器的有效性,首先应用数值仿真证明所设计的控制器可以对单连杆柔性机械臂系统进行有效非对称时变约束控制,然后将所设计的控制器应用于单连杆柔性机械臂的控制。并且为了比较动态面控制方法对系统跟踪速度的影响,在每个仿真例子中都应用了以下两种控制方法:
1:应用本发明所提的基于方法的对单连杆柔性机械臂系统的全状态非对称时变约束控制方案。
2:将传统的非对称时变约束控制方案应用于单连杆柔性机械臂系统控制。
数值仿真
为验证上述系统有效,进行验证仿真实验,针对如下带有外部扰动和全状态非对称时变约束的单连杆柔性机械臂系统,
系统非对称时变约束区间的上下界分别设置为:
Claims (4)
1.一种单连杆柔性机械臂跟踪控制方法,其特征在于,所述方法建立直流电动机控制的单连杆柔性机械臂系统的动力学模型;根据实际的要求所述的针对带有输出非对称时变约束的单连杆柔性机械臂的跟踪控制方法,包括以下步骤:
步骤一:
建立单连杆柔性机械臂系统的动力学模型,包括单连杆柔性机械臂系统的控制方程及单连杆柔性机械臂末端角位移的运动方程;
其中,
是电机转子惯性,是连杆质量,是负载质量,是连杆长度,是负载半径,是重力加速度,是粘滞摩擦系数;代表电机角位移(同时也是机械臂关节角度),代表电机电枢电流,是转矩系数,是电枢电感,是电枢电阻,是反电动势系数,代表输人控制电压;
步骤二:
步骤三:将实际控制器应用于单连杆柔性机械臂的控制,设计非对称时变约束区间,对单连杆柔性机械臂的转角、转动速度和转矩进行约束控制;
步骤四:依据动力学模型,确定带有输出约束的实际控制器,对带有输出约束的单连杆柔性机械臂的模糊进行抑制的同时,控制单连杆柔性机械臂转动到期望角位置之后,通过李雅普诺夫直接法对实际控制器进行稳定性分析;
步骤五:通过李雅普诺夫直接法对所述实际控制器进行稳定性分析之后,并通过仿真验证实际控制器的可行性及有效性。
4.根据权利要求1所述的一种单连杆柔性机械臂跟踪控制方法,其特征在于,所述带有输出非对称时变约束的单连杆柔性机械臂的跟踪控制方法,该方法通过李雅普诺夫直接法对实际控制器进行稳定性分析,包括构造针对单连杆柔性机械臂的闭环系统的李雅普诺夫候选函数若李雅普诺夫候选函数是正定的,且李雅普诺夫候选函数对时间的导数半负定,则判定实际控制器能使单连杆柔性机械臂的闭环系统渐进稳定。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202210277091.8A CN114859708A (zh) | 2022-03-21 | 2022-03-21 | 一种单连杆柔性机械臂跟踪控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202210277091.8A CN114859708A (zh) | 2022-03-21 | 2022-03-21 | 一种单连杆柔性机械臂跟踪控制方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN114859708A true CN114859708A (zh) | 2022-08-05 |
Family
ID=82627114
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202210277091.8A Pending CN114859708A (zh) | 2022-03-21 | 2022-03-21 | 一种单连杆柔性机械臂跟踪控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN114859708A (zh) |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN116690561A (zh) * | 2023-05-30 | 2023-09-05 | 渤海大学 | 一种用于单连杆机械臂的自适应最优反步控制方法及系统 |
CN117359645A (zh) * | 2023-12-04 | 2024-01-09 | 青岛理工大学 | 一种单连杆机械臂的自适应预定义时间控制方法 |
-
2022
- 2022-03-21 CN CN202210277091.8A patent/CN114859708A/zh active Pending
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN116690561A (zh) * | 2023-05-30 | 2023-09-05 | 渤海大学 | 一种用于单连杆机械臂的自适应最优反步控制方法及系统 |
CN116690561B (zh) * | 2023-05-30 | 2024-01-23 | 渤海大学 | 一种用于单连杆机械臂的自适应最优反步控制方法及系统 |
CN117359645A (zh) * | 2023-12-04 | 2024-01-09 | 青岛理工大学 | 一种单连杆机械臂的自适应预定义时间控制方法 |
CN117359645B (zh) * | 2023-12-04 | 2024-02-23 | 青岛理工大学 | 一种单连杆机械臂的自适应预定义时间控制方法 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
Visioli et al. | On the trajectory tracking control of industrial SCARA robot manipulators | |
CN108983606A (zh) | 一种机械臂系统的鲁棒滑模自适应控制方法 | |
CN114859708A (zh) | 一种单连杆柔性机械臂跟踪控制方法 | |
Hashemi et al. | Model-based PI–fuzzy control of four-wheeled omni-directional mobile robots | |
JP2763832B2 (ja) | 未知ダイナミックスを含むプラントの制御装置および方法 | |
CN111788040A (zh) | 机器人的动力学参数辨识方法、机器人和存储装置 | |
CN102385342B (zh) | 虚拟轴机床并联机构运动控制的自适应动态滑模控制方法 | |
CN106873383B (zh) | 一种降低工业机器人振动的在线控制方法 | |
CN109352656B (zh) | 一种具有时变输出约束的多关节机械臂控制方法 | |
CN105652667B (zh) | 一种模型不确定双关节机械手的高精度轨迹跟踪控制方法 | |
CN114043480A (zh) | 一种基于模糊控制的自适应阻抗控制算法 | |
CN115990888A (zh) | 一种具有死区和时变约束功能的机械臂控制方法 | |
Yu et al. | A rate-difference disturbance observer control for a timing-belt servo system | |
Kang et al. | Kinematic path‐tracking of mobile robot using iterative learning control | |
Agostini et al. | Generating swing-suppressed maneuvers for crane systems with rate saturation | |
JPS5932012A (ja) | 位置決めサ−ボ方式 | |
CN109884890B (zh) | 一种电驱动机械臂伺服系统的时变约束反演控制方法 | |
Ohri et al. | Comparison of robustness of PID control and sliding mode control of robotic manipulator | |
Lin et al. | Robust recurrent-neural-network sliding-mode control for the XY table of a CNC machine | |
CN116638544A (zh) | 一种基于超局部模型的关节模组协同控制方法 | |
Abedini et al. | Tuning of an optimal PID controller with iterative feedback tuning method for DC motor | |
CN115179300A (zh) | 一种预定时间的柔性机械臂轨迹跟踪控制方法 | |
Beata | Fuzzy logic controller for robot manipulator control system | |
Visioli et al. | Adaptive friction compensation for industrial robot control | |
CN108638064B (zh) | 一种基于均值耦合的多机械臂系统自适应参数辨识与位置同步控制方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination |