CN112077847B - 受非匹配干扰机器人的位置跟踪控制方法 - Google Patents
受非匹配干扰机器人的位置跟踪控制方法 Download PDFInfo
- Publication number
- CN112077847B CN112077847B CN202010932477.9A CN202010932477A CN112077847B CN 112077847 B CN112077847 B CN 112077847B CN 202010932477 A CN202010932477 A CN 202010932477A CN 112077847 B CN112077847 B CN 112077847B
- Authority
- CN
- China
- Prior art keywords
- robot
- disturbance
- matching
- derivative
- sliding mode
- 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.)
- Active
Links
- 238000000034 method Methods 0.000 title claims abstract description 20
- 239000011159 matrix material Substances 0.000 claims description 12
- 230000003044 adaptive effect Effects 0.000 claims description 10
- 230000005484 gravity Effects 0.000 claims description 7
- 230000003287 optical effect Effects 0.000 claims description 3
- 230000001629 suppression Effects 0.000 abstract description 3
- 238000010276 construction Methods 0.000 description 2
- 238000009795 derivation Methods 0.000 description 2
- 238000005516 engineering process Methods 0.000 description 2
- 230000004075 alteration Effects 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000008878 coupling Effects 0.000 description 1
- 238000010168 coupling process Methods 0.000 description 1
- 238000005859 coupling reaction Methods 0.000 description 1
- 238000012938 design process Methods 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 230000006872 improvement Effects 0.000 description 1
- 239000002184 metal Substances 0.000 description 1
- 210000001364 upper extremity Anatomy 0.000 description 1
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1656—Programme controls characterised by programming, planning systems for manipulators
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1602—Programme controls characterised by the control system, structure, architecture
- B25J9/161—Hardware, e.g. neural networks, fuzzy logic, interfaces, processor
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Automation & Control Theory (AREA)
- Physics & Mathematics (AREA)
- Artificial Intelligence (AREA)
- Evolutionary Computation (AREA)
- Fuzzy Systems (AREA)
- Mathematical Physics (AREA)
- Software Systems (AREA)
- Feedback Control In General (AREA)
Abstract
本发明涉及机器人控制技术领域。本发明公开了一种受非匹配干扰机器人的位置跟踪控制方法。本发明的控制方法,包括受非匹配干扰的机器人、非线性干扰观测器、自适应律模块、指数滑模控制器;其特征在于,包括如下步骤:a、将机器人受到的非匹配干扰d1及其导数定义为集中扰动D;b、设计非线性干扰观测器对机器人受到的集中扰动D进行估计,得到估计值c、采用自适应律对集中扰动的界γ进行估计,得到其估计值d、设计指数滑模控制器τ对机器人进行控制,使得对非匹配干扰抑制的同时实现机器人的实际位置对其期望位置的跟踪;本发明能够有效解决机器人非匹配干扰抑制和位置控制问题,显著提高机器人位置跟踪和抗干扰控制性能,提高系统的稳定性。
Description
技术领域
本发明涉及机器人控制技术领域,特别涉及干扰条件下机器人的位置跟踪控制技术,具体涉及受非匹配干扰机器人的位置跟踪控制方法。
背景技术
机器人系统是一个具有强耦合、不确定性和各种干扰的多输入多输出非线性系统。机器人系统受到的干扰会降低位置跟踪性能,甚至破坏系统的稳定性。这些干扰往往可以分为两类:匹配类型和非匹配类型。如果干扰通过控制输入通道影响系统的状态,即干扰和控制输入两者在同一通道内,则为匹配干扰。如果干扰直接影响系统的状态,即干扰和控制输入两者不在同一通道内,则为非匹配干扰。
为了对机器人系统所受干扰进行抑制,针对上肢外骨骼机器人【Z.J.Li,C.Y.Su,L.Y.Wang,et al.Nonlinear disturbance observer-based control design for arobotic exoskeleton incorporating fuzzy approximation.IEEE Transactions onIndustrial Electronics,2015,62(9):5763-5775.】,Li等设计了非线性干扰观测器对由未知输入饱和、模糊逼近误差、粘性摩擦、重力和负载等因素引起的扰动力矩进行补偿。针对双关节柔性机械手【J.N.Yun,J.B.Su.Design of a disturbance observer for a two-link manipulator with flexible joints.IEEE Transactions Control SystemsTechnology,2014,22(2):809-815.】,Yun等提出一种基于滤波器和干扰观测器的鲁棒控制方法,实现了最佳的干扰抑制性能。然而,以上文献中的干扰观测器只能补偿满足匹配条件的干扰,均没有考虑非匹配干扰。针对含匹配和非匹配干扰的二阶系统【乔建忠,朱玉凯,郭雷,等.一种基于干扰观测器的非匹配干扰系统自抗扰控制方法.中国发明专利申请号:CN201710579482.4】,乔建忠等提出了一种基于干扰观测器的非匹配干扰系统自抗扰控制方法,对谐波干扰进行了抑制,但是此方法只适用于单输入单输出的非线性系统。在实际应用中,机器人系统通常是多输入多输出的,且不仅受匹配干扰的影响,而且受非匹配干扰的影响。由于非匹配干扰和控制输入不在同一通道内,故非匹配干扰更难以消除。因此,针对多输入多输出的机器人设计能够解决非匹配干扰的控制器具有重要意义。
发明内容
本发明的主要目的在于提供一种受非匹配干扰机器人的位置跟踪控制方法,在受到非匹配干扰时实现机器人实际位置对其期望位置的跟踪。
为了实现上述目的,根据本发明具体实施方式的一个方面,提供了一种受非匹配干扰机器人的位置跟踪控制方法,包括受非匹配干扰的机器人、非线性干扰观测器、自适应律模块、指数滑模控制器;其特征在于,包括如下步骤:
a、将机器人受到的非匹配干扰d1及其导数定义为集中扰动D;
d、设计指数滑模控制器τ对机器人进行控制,使得对非匹配干扰抑制的同时实现机器人的实际位置对其期望位置的跟踪;
所述非线性干扰观测器的输入包括机器人的位置误差e,e=q-qd,其中q为机器人的实际位置,qd为机器人的期望位置;集中扰动的界的估计值以及指数滑模控制器的输出τ;所述非线性干扰观测器的输出为集中扰动的估计值
所述非线性干扰观测器表达式为:
其中,β为非线性干扰观测器的状态变量,为其一阶导数;x1和x2分别为机器人的实际位置和速度,x1=q,M(x1)为机器人的正定惯性矩阵,M-1(x1)为其逆矩阵;C(x1,x2)为哥氏力和离心力项;G(x1)为重力项;τ为指数滑模控制器的输出;δ为正常数;为集中扰动的界的估计值;α为干扰观测器的辅助变量;xd1为机器人的期望位置,为其一阶导数,为其二阶导数;e为位置误差,为其一阶导数;为集中扰动的估计值。
进一步的,所述指数滑模控制器的输出τ表达式为:
其中,x1和x2分别为机器人的实际位置和速度;M(x1)为机器人的正定惯性矩阵,M-1(x1)为其逆矩阵;C(x1,x2)为哥氏力和离心力项;G(x1)为重力项;xd1为机器人的期望位置,为其一阶导数,为其二阶导数;为集中扰动的估计值;c为正常数;K为常数切换增益;σ为滑模面s减去α的差值,即:σ=s-α,滑模面h为正常数;sgn(.)是符号函数;α为干扰观测器的辅助变量;为位置误差e的一阶导数。
根据本发明技术方案及其在某些实施例中进一步改进的技术方案,本发明具有如下有益效果:
能够有效解决机器人非匹配干扰抑制和位置控制问题,显著提高机器人位置跟踪和抗干扰控制性能,提高系统的稳定性。
下面结合附图和具体实施方式对本发明做进一步的说明。本发明附加的方面和优点将在下面的描述中部分给出,部分将从下面的描述中变得明显,或通过本发明的实践了解到。
附图说明
构成本申请的一部分的附图用来提供对本发明的进一步理解,本发明的具体实施方式、示意性实施例及其说明用于解释本发明,并不构成对本发明的不当限定。在附图中:
图1为本发明受非匹配干扰机器人的位置跟踪控制系统框图。
其中,
1为指数滑模控制器;
2为自适应律模块;
3为非线性干扰观测器;
4为受非匹配干扰的机器人。
具体实施方式
需要说明的是,在不冲突的情况下,本申请中的具体实施方式、实施例以及其中的特征可以相互组合。现将参考附图并结合以下内容详细说明本发明。
为了使本领域技术人员更好的理解本发明方案,下面将结合本发明具体实施方式、实施例中的附图,对本发明具体实施方式、实施例中的技术方案进行清楚、完整的描述,显然,所描述的实施例仅仅是本发明一部分实施例,而不是全部的实施例。基于本发明中的具体实施方式、实施例,本领域普通技术人员在没有做出创造性劳动的前提下所获得的所有其他实施方式、实施例,都应当属于本发明保护的范围。
如图1所示,受非匹配干扰机器人的位置跟踪控制系统,包括受非匹配干扰的机器人4、非线性干扰观测器3、自适应律模块2、指数滑模控制器1。
本发明受非匹配干扰机器人的位置跟踪控制方法包括:
1、将机器人受到的非匹配干扰d1及其导数定义为集中扰动D。
4、以指数滑模控制器是输出τ对机器人进行控制,使得对非匹配干扰抑制的同时实现机器人的关节实际位置对其期望位置的跟踪。
(1)受非匹配干扰机器人的位置跟踪控制系统设计过程如下:
非线性干扰观测器3的输入包括机器人的位置误差e,e=q-qd,其中q为机器人的实际位置,qd为机器人的期望位置;集中扰动的界的估计值以及指数滑模控制器的输出τ;非线性干扰观测器3的输出为集中扰动的估计值
所述非线性干扰观测器表达式为:
其中,β为非线性干扰观测器的状态变量;x1和x2分别为机器人的实际位置和速度,x1=q,M(x1)为机器人的正定惯性矩阵,M-1(x1)为其逆矩阵;C(x1,x2)为哥氏力和离心力项;G(x1)为重力项;τ为指数滑模控制器的输出;δ为正常数;为集中扰动的界的估计值;α为干扰观测器的辅助变量;xd1为机器人的期望位置,为其一阶导数,为其二阶导数;e为位置误差,为其一阶导数;为集中扰动的估计值。
所述自适应律模块的输出表达式为:
所述指数滑模控制器输出为:
其中,x1和x2分别为机器人的实际位置和速度;M(x1)为机器人的正定惯性矩阵,M-1(x1)为其逆矩阵;C(x1,x2)为哥氏力和离心力项;G(x1)为重力项;xd1为机器人的期望位置,为其一阶导数,为其二阶导数;为集中扰动的估计值;c为正常数;K为常数切换增益;σ为滑模面s减去α的差值,即:σ=s-α,滑模面h为正常数;sgn(.)是符号函数;α为干扰观测器的辅助变量;为位置误差e的一阶导数。
受非匹配干扰机器人的位置跟踪控制系统的控制核心部分可看作由3部分组成:自适应律模块用于估计集中扰动的界;非线性干扰观测器用于估计集中扰动;指数滑模控制器使得对非匹配干扰抑制的同时实现机器人的实际位置对其期望位置的跟踪。
(2)系统稳定性和位置跟踪性能的证明
定义一个Lyapunov函数:
对其进行求导可得:
因此,存在根据Barbalat引理【J.J.E.Slotine and W.Li,Appliednonlinear control.Prentice-Hall,Englewood Cliffs,NJ,1991.】可以得到进而得到故干扰观测器的观测误差渐进趋向于0。
又定义一个Lyapunov函数:
求得其导数为:
再定义一个Lyapunov函数:
对其进行求导可得:
位置跟踪控制系统可以有效地补偿非匹配干扰,使得机器人可以精确地跟踪期望位置,提高系统的稳定性。
Claims (5)
1.受非匹配干扰机器人的位置跟踪控制方法,包括受非匹配干扰的机器人、非线性干扰观测器、自适应律模块、指数滑模控制器;其特征在于,包括如下步骤:
a、将机器人受到的非匹配干扰d1及其导数定义为集中扰动D;
d、设计指数滑模控制器τ对机器人进行控制,使得对非匹配干扰抑制的同时实现机器人的实际位置对其期望位置的跟踪;
所述非线性干扰观测器的输入包括机器人的位置误差e,e=q-qd,其中q为机器人的实际位置,qd为机器人的期望位置;集中扰动的界的估计值以及指数滑模控制器的输出τ;所述非线性干扰观测器的输出为集中扰动的估计值
所述非线性干扰观测器表达式为:
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010932477.9A CN112077847B (zh) | 2020-09-08 | 2020-09-08 | 受非匹配干扰机器人的位置跟踪控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010932477.9A CN112077847B (zh) | 2020-09-08 | 2020-09-08 | 受非匹配干扰机器人的位置跟踪控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN112077847A CN112077847A (zh) | 2020-12-15 |
CN112077847B true CN112077847B (zh) | 2022-02-22 |
Family
ID=73732518
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202010932477.9A Active CN112077847B (zh) | 2020-09-08 | 2020-09-08 | 受非匹配干扰机器人的位置跟踪控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN112077847B (zh) |
Families Citing this family (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113419565B (zh) * | 2021-06-08 | 2022-05-31 | 宁波城市职业技术学院 | 四旋翼飞行器预设性能轨迹跟踪反演控制方法及系统 |
CN113601508B (zh) * | 2021-08-16 | 2022-07-08 | 山东大学 | 一种机器人运动控制方法、系统及机器人 |
CN117706910B (zh) * | 2023-12-27 | 2024-06-07 | 哈尔滨工业大学 | 基于滑模控制的不同最大速度的机器人集群覆盖方法及系统 |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS63169279A (ja) * | 1987-01-07 | 1988-07-13 | フアナツク株式会社 | ロボツト制御装置 |
WO2013180222A1 (ja) * | 2012-05-30 | 2013-12-05 | 株式会社神戸製鋼所 | 多関節ロボットの軌跡制御装置および制御方法 |
CN106877658A (zh) * | 2017-03-27 | 2017-06-20 | 江苏大学 | 一种功率变换器的复合非奇异终端滑模控制方法 |
CN107168072A (zh) * | 2017-07-17 | 2017-09-15 | 北京航空航天大学 | 一种基于干扰观测器的非匹配干扰系统自抗扰控制方法 |
CN111251288A (zh) * | 2020-04-01 | 2020-06-09 | 重庆邮电大学 | 一种基于时变干扰补偿的柔性机器人串级控制系统及方法 |
CN111618858A (zh) * | 2020-06-02 | 2020-09-04 | 台州学院 | 一种基于自适应模糊滑模的机械手鲁棒跟踪控制算法 |
-
2020
- 2020-09-08 CN CN202010932477.9A patent/CN112077847B/zh active Active
Patent Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS63169279A (ja) * | 1987-01-07 | 1988-07-13 | フアナツク株式会社 | ロボツト制御装置 |
EP0298128B1 (en) * | 1987-01-07 | 1994-06-08 | Fanuc Ltd. | Robot controller |
WO2013180222A1 (ja) * | 2012-05-30 | 2013-12-05 | 株式会社神戸製鋼所 | 多関節ロボットの軌跡制御装置および制御方法 |
CN106877658A (zh) * | 2017-03-27 | 2017-06-20 | 江苏大学 | 一种功率变换器的复合非奇异终端滑模控制方法 |
CN107168072A (zh) * | 2017-07-17 | 2017-09-15 | 北京航空航天大学 | 一种基于干扰观测器的非匹配干扰系统自抗扰控制方法 |
CN111251288A (zh) * | 2020-04-01 | 2020-06-09 | 重庆邮电大学 | 一种基于时变干扰补偿的柔性机器人串级控制系统及方法 |
CN111618858A (zh) * | 2020-06-02 | 2020-09-04 | 台州学院 | 一种基于自适应模糊滑模的机械手鲁棒跟踪控制算法 |
Also Published As
Publication number | Publication date |
---|---|
CN112077847A (zh) | 2020-12-15 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN112077847B (zh) | 受非匹配干扰机器人的位置跟踪控制方法 | |
Diao et al. | Adaptive fuzzy event-triggered control for single-link flexible-joint robots with actuator failures | |
Li et al. | Adaptive neural tracking control for an uncertain state constrained robotic manipulator with unknown time-varying delays | |
CN108388114B (zh) | 一种基于输出重定义的柔性机械臂复合控制方法 | |
CN113534666A (zh) | 多目标约束下单关节机械臂系统的轨迹跟踪控制方法 | |
CN107942670B (zh) | 一种双柔性空间机械臂模糊鲁棒滑模削抖运动控制方法 | |
CN110434858B (zh) | 一种基于命令滤波的多机械臂系统的力/位混合控制方法 | |
CN108646569B (zh) | 离散时间状态下的遥操作系统的控制方法 | |
CN106406097B (zh) | 多机械臂系统的分布式自适应协调控制方法 | |
Sun et al. | Novel sliding-mode disturbance observer-based tracking control with applications to robot manipulators | |
Guo et al. | Fixed-time fuzzy adaptive control of manipulator systems under multiple constraints: A modified dynamic surface control approach | |
Xu et al. | Robust adaptive fuzzy fault tolerant control of robot manipulators with unknown parameters | |
Guo et al. | Locally weighted learning robot control with improved parameter convergence | |
Zhong et al. | A sliding mode and non-linear disturbance observer based bilateral control for telerehabilitation systems with flexible manipulators | |
Shi et al. | Neural adaptive intermittent output feedback control for autonomous underwater vehicles with full-state quantitative designs | |
CN113219825A (zh) | 一种四足机器人单腿轨迹跟踪控制方法及系统 | |
Hu | Neural network‐based adaptive attitude tracking control for flexible spacecraft with unknown high‐frequency gain | |
Rezoug et al. | Adaptive fuzzy nonsingular terminal sliding mode controller for robot manipulator actuated by pneumatic artificial muscles | |
Vyas et al. | Comparison of conventional & fuzzy based sliding mode PID controller for robot manipulator | |
Li et al. | Impedance control for human-robot interaction with an adaptive fuzzy approach | |
Yazdanzad et al. | Combined neural network feedforward and RISE feedback control structure for a 5 DOF Upper-limb exoskeleton robot with asymptotic tracking | |
Macnab | Neural-adaptive backstepping for flexible-joint robots with neither extra parameters, extra networks, nor robust terms | |
Wang et al. | Robust trajectory tracking for manipulators with joint flexibility via backstepping | |
Moradizirkohi et al. | Direct adaptive fuzzy control of flexible-joint robots including actuator dynamics using particle swarm optimization | |
CN118438438B (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 | ||
GR01 | Patent grant | ||
GR01 | Patent grant | ||
TR01 | Transfer of patent right | ||
TR01 | Transfer of patent right |
Effective date of registration: 20240112 Address after: 230000 floor 1, building 2, phase I, e-commerce Park, Jinggang Road, Shushan Economic Development Zone, Hefei City, Anhui Province Patentee after: Dragon totem Technology (Hefei) Co.,Ltd. Address before: 610039 No. 999, golden week Road, Chengdu, Sichuan, Jinniu District Patentee before: XIHUA University |