CN105159084B - 一种带干扰观测器的机械手神经网络控制系统及方法 - Google Patents
一种带干扰观测器的机械手神经网络控制系统及方法 Download PDFInfo
- Publication number
- CN105159084B CN105159084B CN201510561545.4A CN201510561545A CN105159084B CN 105159084 B CN105159084 B CN 105159084B CN 201510561545 A CN201510561545 A CN 201510561545A CN 105159084 B CN105159084 B CN 105159084B
- Authority
- CN
- China
- Prior art keywords
- manipulator
- manipulator system
- neural network
- disturbance
- addition
- 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 27
- 210000005036 nerve Anatomy 0.000 title abstract 3
- 238000013528 artificial neural network Methods 0.000 claims description 88
- 238000004364 calculation method Methods 0.000 claims description 30
- 238000006073 displacement reaction Methods 0.000 claims description 24
- 239000013598 vector Substances 0.000 claims description 17
- 239000011159 matrix material Substances 0.000 claims description 14
- 238000012545 processing Methods 0.000 claims description 6
- 238000005259 measurement Methods 0.000 claims description 5
- 241000252229 Carassius auratus Species 0.000 claims description 4
- 230000001133 acceleration Effects 0.000 claims description 4
- 230000005484 gravity Effects 0.000 claims description 4
- 230000000694 effects Effects 0.000 abstract description 3
- 230000001537 neural effect Effects 0.000 abstract 2
- 238000010586 diagram Methods 0.000 description 6
- 230000003044 adaptive effect Effects 0.000 description 3
- 239000002184 metal Substances 0.000 description 3
- 238000004088 simulation Methods 0.000 description 3
- 238000004422 calculation algorithm Methods 0.000 description 2
- 210000002569 neuron Anatomy 0.000 description 2
- 230000004075 alteration Effects 0.000 description 1
- 230000015556 catabolic process Effects 0.000 description 1
- 238000006731 degradation reaction Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 230000001629 suppression Effects 0.000 description 1
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
-
- 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
- G05B2219/00—Program-control systems
- G05B2219/30—Nc systems
- G05B2219/32—Operator till task planning
- G05B2219/32335—Use of ann, neural network
-
- 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
- G05B2219/00—Program-control systems
- G05B2219/30—Nc systems
- G05B2219/33—Director till display
- G05B2219/33004—Manual control of manipulator, machine
Landscapes
- Engineering & Computer Science (AREA)
- Health & Medical Sciences (AREA)
- Artificial Intelligence (AREA)
- Computer Vision & Pattern Recognition (AREA)
- Evolutionary Computation (AREA)
- Medical Informatics (AREA)
- Software Systems (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Feedback Control In General (AREA)
- Control Of Position Or Direction (AREA)
Abstract
本发明公开的一种带干扰观测器的机械手神经网络控制系统及方法,采用第一加法运算器、RBF神经网络运算器、第二加法运算器、计算转矩控制器、第三加法运算器、机械手系统及扰动观测器建立带干扰观测器的神经网络系统控制系统,能够处理机械手系统中的动力学不确定项及外部扰动。其中,RBF神经网络运算器用于逼近机械手系统不确定的动力学参数引起的动力学不确定项;扰动观测器用于对外部扰动进行估计和补偿。本发明同时还能够验证控制方法对动力学不确定项和外部扰动一直的有效性,具有良好的跟踪效果。本发明能够有效地提高机械手系统的控制性能和跟踪精度。
Description
技术领域
本发明涉及一种机械手控制系统及控制方法,具体涉及一种带干扰观测器的机械手神经网络控制系统及方法。
背景技术
机械手是非常复杂的多输入多输出非线性系统,不可避免的存在各种不确定性,无法获得系统精确的动力学模型,其控制十分复杂。从系统内部来看,由于测量和建模的不精确,动力学模型的参数很难确切的知道,如机器人每个连杆的质量、长度等;从外部来看,系统还会受到负载的变化以及各种不可预测的扰动的影响。因此,针对机械手中存在的参数不确定和外部扰动,需要设计适当的控制方案保证系统的鲁棒性。
在具有外界干扰和参数不确定的情况下,为了提高机械手控制系统的跟踪精度,目前主要有自适应控制方法、智能控制方法,干扰观测器方法和鲁棒控制方法。但自适应控制和鲁棒控制等方法对机械手的动力学模型的精确度要求较高。而神经网络由于不依赖于系统模型,具有以任意精度逼近任意非线性函数的万能逼近特性,非常适合用于逼近系统动力学模型中的未知参数,即未建模动态项,以消除系统未建模动力学的影响。干扰观测器的基本思想是通过构造新的动态系统对原系统中不确定因素进行观测或估计,然后利用观测器的估计输出,抵消不确定性的影响,提高已有控制器的控制性能。因此,干扰观测器对不可预测的或随机的外部干扰具有很好的抑制效果,极大地增强了系统的鲁棒性。
发明内容
本发明的目的在于提供一种带干扰观测器的机械手神经网络系统及控制方法,采用第一加法运算器、RBF神经网络运算器、第二加法运算器、计算转矩控制器、第三加法运算器、机械手系统及扰动观测器建立带干扰观测器的机械手神经网络控制系统,能够处理机械手系统中的动力学不确定项及外部扰动。其中,RBF神经网络运算器用于逼近机械手系统不确定的动力学参数引起的动力学不确定项;扰动观测器用于对外部扰动进行估计和补偿。本发明同时还能够验证控制方法对动力学不确定项和外部扰动一直的有效性,具有良好的跟踪效果。本发明能够有效地提高机械手系统的控制性能和跟踪精度。
为了达到上述目的,本发明通过以下技术方案实现:
一种带干扰观测器的机械手神经网络控制系统,其特点是,该控制系统包含:
第一加法运算器,所述第一加法运算器的第一输入端输入机械手系统的期望运动位移信号;
RBF神经网络运算器,所述RBF神经网络运算器的第一输入端与所述第一加法运算器的输出端连接;
第二加法运算器,所述第二加法运算器器的第一输入端输入机械手系统的期望运动速度信号;该第二加法运算器器的输出端与所述RBF神经网络运算器的第二输入端连接;
计算转矩控制器,所述计算转矩控制器的第一输入端与所述第一加法运算器的输出端连接,该计算转矩控制器的第二输入端与所述第二加法运算器的输出端连接;
第三加法运算器,所述第三加法运算器的第一输入端与所述RBF神经网络运算器的输出端连接,该第三加法运算器的第二输入端与所述计算转矩控制器的输出端连接;
机械手系统,所述机械手系统的输入端与所述第三加法运算器的输出端连接,该机械手系统的第一输出端与所述第一加法运算器的第二输入端连接,该机械手系统的第二输出端与所述第二加法运算器的第二输入端连接;
扰动观测器,所述扰动观测器的第一输入端与所述第三加法运算器的输出端连接,该扰动观测器的第二输入端与所述机械手系统的第二输出端连接,该扰动观测器的输出端与所述第三加法运算器的第三输入端连接。
优选地,
所述机械手系统的第一输出端输出该机械手系统的关节位移信号,所述机械手系统的第二输出端输出该机械手系统的关节速度信号;
所述第一加法运算器将所述机械手系统的关节位移信号与所述期望运动位移信号进行相减运算,并将运算结果分别输入所述RBF神经网络运算器、所述计算转矩控制器。
优选地,
所述第二加法运算器将所述机械手系统的关节速度信号与所述机械手系统的期望运动速度信号进行相减运算,并将运算结果分别输入所述RBF神经网络运算器、所述计算转矩控制器。
优选地,
所述RBF神经网络运算器分别获取所述第一加法运算器、所述第二加法运算器的结果后进行计算处理,获取所述机械手系统的动力学不确定项;
所述计算转矩控制器分别获取所述第一加法运算器、所述第二加法运算器的结果后进行计算处理,获取所述机械手系统的标称控制力矩;
所述扰动观测器获取所述第三加法运算器的输出的机械手系统的关节控制力矩、所述机械手系统第二输出端输出的机械手系统的关节速度信号,计算出该机械手系统的扰动项估计值;
所述第三加法运算器将所述RBF神经网络运算器输出的机械手系统的动力学不确定项、所述计算转矩控制器输出的机械手系统的标称控制力矩及所述扰动观测器输出的机械手系统的扰动项估计值进行相加运算,从而获取所述机械手系统的关节控制力矩;并将该机械手系统的关节控制力矩信号发送至所述机械手系统的输入端。
一种带干扰观测器的机械手神经网络控制系统的控制方法,其特点是,该控制方法包含:
S1,根据现有机械手系统,建立带干扰观测器的机械手神经网络控制系统的动力学模型;
S2,针对所述步骤S1中动力学模型的标称模型部分,采用第一加法器、第二加法器及计算转矩控制器计算标称控制力矩;
S3,当不考虑外部干扰时,采用所述第一加法器、所述第二加法器及RBF神经网络运算器计算出所述步骤S1中动力学模型的动力学不确定项;
S4,当考虑外部干扰时,为减少外部干扰对机械手系统的影响,采用第三加法器、扰动观测器计算出该机械手系统的扰动项估计值;
S5,根据所述步骤S4,对建立带干扰观测器的机械手神经网络系统控制系统的动力学模型的扰动项估计值进行稳定性分析判断。
优选地,所述步骤S1包含:
S1.1,现有机械手系统的动力学方程为:
其中,和分别表示所述机械手系统的关节的位移、速度和加速度矢量.M(q)∈Rn×n为对称正定的惯量矩阵,为离心力和哥氏力矢量,G(q)∈Rn为重力矢量。d表示外部扰动项,τ是所述机械手系统的关节控制力矩;
S1.2,由于现有所述机械手系统存在参数测量误差、外部环境以及负载的变化,很难获得精确的机械手动力学模型,模型中通常存在不确定性和外部干扰;因此带干扰观测器的机械手神经网络控制系统,将机械手动力学模型分为标称模型及动力学模型不确定项;
其中,标称模型的参数矩阵为:M0(q),G0(q),动力学模型不确定项的参数矩阵为:ΔM(q),和ΔG(q);则:
ΔM(q)=M0(q)-M(q) (2);
ΔG(q)=G0(q)-G(q) (4)。
优选地,所述步骤S2包含:
S2.1,所述第一加法器将所述机械手系统的关节位移信号q与所述期望运动位移信号qd进行相减运算,获取所述机械手系统的位置跟踪误差e:
e=q-qd (5);
将该位置跟踪误差e分别输入所述RBF神经网络运算器、所述计算转矩控制器中;
S2.2,所述第二加法器将所述机械手系统的关节速度信号与所述机械手系统的期望运动速度信号进行相减运算,获取所述机械手系统的速度跟踪误差
将该速度跟踪误差分别输入所述RBF神经网络运算器、所述计算转矩控制器中;
S2.3,根据所述式(2)-式(6),所述计算转矩控制器计算标称控制力矩:
其中,kv为微分控制增益值;kp为比例控制增益值。
优选地,所述步骤S3包含:
S3.1,根据式(1)、式(7)可得到:
其中,表示为所述步骤S1中动力学模型
的动力学不确定项;
在不考虑外部干扰时,式(8)可改写为:
S3.2,令则误差方程(9)可写成如下状态空间形式
其中,
采用所述RBF神经网络运算器估算所述机械手系统不确定的动力学参数引起的动力学不确定项f(x)。
优选地,所述步骤S4包含:
S4.1,在不考虑所述步骤S1中动力学模型的动力学不确定项时,式(1)可改写为:
令则式(10)可写为:
S4.2,所述扰动观测器获取所述第三加法运算器的输出的机械手系统的关节控制力矩τ、所述机械手系统第二输出端输出的机械手系统的关节速度信号计算出该机械手系统的扰动项估计值:
其中,将式(12)代入式(13)可得:
其中,为对扰动项d'的估计值,是对的估计值,k1、k2为常数,并且k1>0,k2>0。
优选地,所述步骤S5包含:
S5.1,定义所述机械手系统的李雅普诺夫函数V:
其中,
则可知:
假设d为慢时变干扰,则很小,当取较大的k1值时,有
S5.2,将式(13)、式(14)及式(17)代入式(16)可得:
可知,所述扰动观测器能够对扰动项d'进行有效观测,从而实现补偿。
本发明与现有技术相比具有以下优点:
本发明公开的一种带干扰观测器的机械手神经网络系统及控制方法,针对存在外部扰动和动力学不确定项的机械手系统进行高精度控制。采用第一加法运算器、RBF神经网络运算器、第二加法运算器、计算转矩控制器、第三加法运算器、机械手系统及扰动观测器建立带干扰观测器的机械手神经网络控制系统,能够处理机械手系统中的动力学不确定项及外部扰动。其中,RBF神经网络运算器用于逼近机械手系统不确定的动力学参数引起的动力学不确定项;扰动观测器用于对外部扰动进行估计和补偿。本发明同时还能够验证控制方法对动力学不确定项和外部扰动一直的有效性,具有良好的跟踪效果。本发明能够有效地提高机械手系统的控制性能和跟踪精度。
附图说明
图1为本发明一种带干扰观测器的机械手神经网络控制系统的整体结构示意图。
图2为本发明一种带干扰观测器的机械手神经网络控制系统的控制方法的整体流程示意图。
图3为本发明一种带干扰观测器的机械手神经网络控制系统的控制方法的位置跟踪实施例示意图。
图4为本发明一种带干扰观测器的机械手神经网络控制系统的控制方法的位置跟踪误差实施例示意图。
图5为本发明一种带干扰观测器的机械手神经网络控制系统的控制方法的控制输入实施例示意图。
图6为本发明一种带干扰观测器的机械手神经网络控制系统的控制方法的动力学不确定项及RBF神经网络估算结果实施例示意图。
图7为本发明一种带干扰观测器的机械手神经网络控制系统的控制方法的外部扰动及其估计值实施例示意图。
具体实施方式
以下结合附图,通过详细说明一个较佳的具体实施例,对本发明做进一步阐述。
如图1所示,一种带干扰观测器的机械手神经网络控制系统,该控制系统包含:第一加法运算器1、RBF神经网络运算器3(Radical Basis Function,径向基函数,简称RBF)、第二加法运算器2、计算转矩控制器4、第三加法运算器7、机械手系统5及扰动观测器6。
其中,第一加法运算器1的第一输入端输入机械手系统5的期望运动位移信号qd;RBF神经网络运算器3的第一输入端与第一加法运算器1的输出端连接;第二加法运算器2器的第一输入端输入机械手系统5的期望运动速度信号该第二加法运算器2器的输出端与RBF神经网络运算器3的第二输入端连接;计算转矩控制器4的第一输入端与第一加法运算器1的输出端连接,该计算转矩控制器4的第二输入端与第二加法运算器2的输出端连接;第三加法运算器7的第一输入端与RBF神经网络运算器3的输出端连接,该第三加法运算器7的第二输入端与计算转矩控制器4的输出端连接;机械手系统5的输入端与第三加法运算器7的输出端连接,该机械手系统5的第一输出端与第一加法运算器1的第二输入端连接,该机械手系统5的第二输出端与第二加法运算器2的第二输入端连接;扰动观测器6的第一输入端与第三加法运算器7的输出端连接,该扰动观测器6的第二输入端与机械手系统5的第二输出端连接,该扰动观测器6的输出端与第三加法运算器7的第三输入端连接。
本发明中,机械手系统5的第一输出端输出该机械手系统5的关节位移信号q,机械手系统5的第二输出端输出该机械手系统5的关节速度信号第一加法运算器1将机械手系统5的关节位移信号q与期望运动位移信号qd进行相减运算,并将运算结果的位置跟踪误差e分别输入RBF神经网络运算器3、计算转矩控制器4。
第二加法运算器2将机械手系统5的关节速度信号与机械手系统5的期望运动速度信号进行相减运算,并将运算结果的速度跟踪误差分别输入RBF神经网络运算器3、计算转矩控制器4。
RBF神经网络运算器3分别获取第一加法运算器1、第二加法运算器2的结果后进行计算处理,获取机械手系统5的动力学不确定项f(x)。
计算转矩控制器4分别获取第一加法运算器1、第二加法运算器2的结果后进行计算处理,获取机械手系统5的标称控制力矩τ0。
扰动观测器6获取第三加法运算器7的输出的机械手系统5的关节控制力矩τ、机械手系统5第二输出端输出的机械手系统的关节速度信号计算出该机械手系统5的扰动项估计值
第三加法运算器7将RBF神经网络运算器3输出的机械手系统5的动力学不确定项f(x)、计算转矩控制器4输出的机械手系统5的标称控制力矩τ0及扰动观测器6输出的机械手系统5的扰动项估计值进行相加运算,从而获取机械手系统5的关节控制力矩τ;并将该机械手系统5的关节控制力矩信号τ发送至机械手系统5的输入端。
如图2所示,一种带干扰观测器的机械手神经网络控制系统的控制方法,该控制方法包含:
S1,根据现有机械手系统5,建立基于干扰观测器6的机械手系统5控制系统的动力学模型。该步骤S1包含:
S1.1,现有机械手系统5的动力学方程为:
其中,,和分别表示机械手系统5的关节的位移、速度和加速度矢量.M(q)∈Rn×n为对称正定的惯量矩阵,为离心力和哥氏力矢量,G(q)∈Rn为重力矢量。d表示外部扰动项,τ是机械手系统5的关节控制力矩;
S1.2,由于现有机械手系统5存在参数测量误差、外部环境以及负载的变化,很难获得精确的机械手动力学模型,模型中通常存在不确定性和外部干扰;因此基于干扰观测器6的机械手系统5控制系统,将机械手动力学模型分为标称模型及动力学模型不确定项;
其中,标称模型的参数矩阵为:M0(q),G0(q),动力学模型不确定项的参数矩阵为:ΔM(q),和ΔG(q);则:
ΔM(q)=M0(q)-M(q) (2);
ΔG(q)=G0(q)-G(q) (4)。
S2,针对步骤S1中动力学模型的标称模型部分,采用第一加法器、第二加法器及计算转矩控制器4计算标称控制力矩。该步骤S2包含:
S2.1,第一加法器将机械手系统5的关节位移信号q与期望运动位移信号qd进行相减运算,获取机械手系统5的位置跟踪误差e:
e=q-qd (5);
将该位置跟踪误差e分别输入RBF神经网络运算器3、计算转矩控制器4中;
S2.2,第二加法器将机械手系统5的关节速度信号与机械手系统5的期望运动速度信号进行相减运算,获取机械手系统5的速度跟踪误差
将该速度跟踪误差分别输入RBF神经网络运算器3、计算转矩控制器4中;
S2.3,根据式(2)-式(6),计算转矩控制器4计算标称控制力矩:
其中,kv为微分控制增益值;kp为比例控制增益值。
S3,当不考虑外部干扰时,采用第一加法器、第二加法器及RBF神经网络运算器3计算出步骤S1中动力学模型的动力学不确定项。该步骤S3包含:
S3.1,根据式(1)、式(7)可得到:
其中,表示为步骤S1中动力学模型的动
力学不确定项,也称为未建模动态;表示外部扰动。
在不考虑外部干扰时,式(8)可改写为:
由于模型建模的不确定会导致控制性能的下降,因此需要对未建模动态和外部扰动进行逼近。
由于RBF神经网络运算器3具有结构简单、收敛速度快的特点,具有其他前向神经网络所不具备的最佳逼近特性和全局最优特性;因此本发明采用RBF神经网络运算器3计算系统的动力学不确定项。
RBF神经网络运算器3的RBF神经网络算法为:
其中,x∈Rn是网络的输入向量,θ为神经网络权值向量,是网络权值θ的估计。为高斯基函数,ci是每个神经元节点的中心,σi是高斯函数的宽度。
已证明RBF神经网络运算器3可以以任意精度逼近紧集内任意连续函数,即:
其中,θ*是最优权值向量,ε0是神经网络逼近误差。
S3.2,令则误差方程(9)可写成如下状态空间形式
其中,
采用RBF神经网络运算器3估算机械手系统不确定的动力学参数引起的动力学不确定项f(x)。
RBF神经网络运算器3的神经网络自适应律设计为:
其中,矩阵P为对称正定矩阵,并满足如下Lyapunov方程:
ATP+PA=-Q Q≥0 (23)。
S4,当考虑外部干扰时,为减少外部干扰对机械手系统5的影响,采用第三加法器、扰动观测器6计算出该机械手系统5的扰动项估计值。该步骤S4包含:
S4.1,在不考虑步骤S1中动力学模型的动力学不确定项时,式(1)可改写为:
令则式(10)可写为:
S4.2,扰动观测器6获取第三加法运算器7的输出的机械手系统5的关节控制力矩τ、所述机械手系统第二输出端输出的机械手系统的关节速度信号计算出该机械手系统5的扰动项估计值:
其中,将式(12)代入式(13)可得:
其中,为对扰动项d'的估计值,是对的估计值,k1、k2为常数,并且k1>0,k2>0。
S5,根据步骤S4,对建立基于干扰观测器6的机械手系统5控制系统的动力学模型的扰动项估计值进行稳定性分析判断。该步骤S5包含:
S5.1,定义机械手系统5的李雅普诺夫函数V:
其中,
则可知:
假设d为慢时变干扰,则很小,当取较大的k1值时,有
一般认为ms级的都属于快系统,以min算的话就慢系统了。本实施例中,当d=1.2sin(0.5πt),也即变化周期为4s时,即为慢时变干扰。
S5.2,将式(13)、式(14)及式(17)代入式(16)可得:
可知,扰动观测器6能够对扰动项d'进行有效观测,从而实现补偿。
本发明的实施例:通过对单力臂机械手进行仿真实验来验证控制算法的有效性。被控对象为
其中G0=mglcosq,d=1.2sin(0.5πt)。取机械手连杆质量m=1,臂杆长度l=0.25,g=9.8。机械手参考输入信号为qd=sin(t),系统初始位置和速度分别为0.15和0。
仿真参数分别选取为:计算转矩控制器参数:Kp=10,Kv=15;RBF神经网络运算器
参数:γ=50,每个神经元节点的中心为0.6,高斯函数的宽度为3。扰动观
测器k1=500,k2=300。仿真结果如图3-7所示。
尽管本发明的内容已经通过上述优选实施例作了详细介绍,但应当认识到上述的描述不应被认为是对本发明的限制。在本领域技术人员阅读了上述内容后,对于本发明的多种修改和替代都将是显而易见的。因此,本发明的保护范围应由所附的权利要求来限定。
Claims (7)
1.一种带干扰观测器的机械手神经网络控制系统,其特征在于,该控制系统包含:
第一加法运算器,所述第一加法运算器的第一输入端输入机械手系统的期望运动位移信号;
RBF神经网络运算器,所述RBF神经网络运算器的第一输入端与所述第一加法运算器的输出端连接;
第二加法运算器,所述第二加法运算器的第一输入端输入机械手系统的期望运动速度信号;该第二加法运算器的输出端与所述RBF神经网络运算器的第二输入端连接;
计算转矩控制器,所述计算转矩控制器的第一输入端与所述第一加法运算器的输出端连接,该计算转矩控制器的第二输入端与所述第二加法运算器的输出端连接;
第三加法运算器,所述第三加法运算器的第一输入端与所述RBF神经网络运算器的输出端连接,该第三加法运算器的第二输入端与所述计算转矩控制器的输出端连接;
机械手系统,所述机械手系统的输入端与所述第三加法运算器的输出端连接,该机械手系统的第一输出端与所述第一加法运算器的第二输入端连接,该机械手系统的第二输出端与所述第二加法运算器的第二输入端连接;
干扰观测器,所述干扰观测器的第一输入端与所述第三加法运算器的输出端连接,该干扰观测器的第二输入端与所述机械手系统的第二输出端连接,该干扰观测器的输出端与所述第三加法运算器的第三输入端连接;
所述带干扰观测器的机械手神经网络控制系统的控制方法包含:
S1,建立带干扰观测器的机械手神经网络控制系统的动力学模型;所述步骤S1包含:
S1.1,现有机械手系统的动力学方程为:
其中,q,和分别表示所述机械手系统的关节的位移、速度和加速度矢量,M(q)∈Rn×n为对称正定的惯量矩阵,为离心力和哥氏力矢量,G(q)∈Rn为重力矢量,d表示外部扰动项,τ是所述机械手系统的关节控制力矩;
S1.2,由于现有所述机械手系统存在参数测量误差、外部环境以及负载的变化,很难获得精确的机械手动力学模型,模型中存在不确定性和外部干扰;因此带干扰观测器的机械手神经网络控制系统,将机械手动力学模型分为标称模型及动力学模型不确定项;
其中,标称模型的参数矩阵为:M0(q),G0(q),动力学模型不确定项的参数矩阵为:△M(q),和△G(q);则:
△M(q)=M0(q)-M(q) (2);
△G(q)=G0(q)-G(q) (4)
S2,针对所述步骤S1中动力学模型的标称模型部分,采用第一加法运算器、第二加法运算器及计算转矩控制器计算标称控制力矩;所述步骤S2包含:
S2.1,所述第一加法运算器将所述机械手系统的关节位移信号q与期望运动位移信号qd进行相减运算,获取所述机械手系统的位置跟踪误差e:
e=q-qd (5);
将该位置跟踪误差e分别输入所述RBF神经网络运算器、所述计算转矩控制器中;
S2.2,所述第二加法运算器将所述机械手系统的关节速度信号与所述机械手系统的期望运动速度信号进行相减运算,获取所述机械手系统的速度跟踪误差
将该速度跟踪误差分别输入所述RBF神经网络运算器、所述计算转矩控制器中;
S2.3,根据所述式(2)-式(6),所述计算转矩控制器计算标称控制力矩:
其中,kv为微分控制增益值;kp为比例控制增益值;
S3,当不考虑外部干扰时,采用所述第一加法运算器、所述第二加法运算器及RBF神经网络运算器计算出所述步骤S1中动力学模型的动力学不确定项;
所述步骤S3包含:
S3.1,根据式(1)、式(7)可得到:
其中,表示为所述步骤S1中动力学模型的动力学不确定项;
在不考虑外部干扰时,式(8)可改写为:
S3.2,令则误差方程(9)可写成如下状态空间形式
其中,
采用所述RBF神经网络运算器估算所述机械手系统不确定的动力学参数引起的动力学不确定项f(x);
S4,当考虑外部干扰时,为减少外部干扰对机械手系统的影响,采用第三加法运算器、干扰观测器计算出该机械手系统的扰动项估计值;
S5,根据所述步骤S4,对带有干扰观测器的机械手神经网络控制系统的动力学模型的扰动项估计值进行稳定性分析判断。
2.如权利要求1所述的带干扰观测器的机械手神经网络控制系统,其特征在于,
所述机械手系统的第一输出端输出该机械手系统的关节位移信号,所述机械手系统的第二输出端输出该机械手系统的关节速度信号;
所述第一加法运算器将所述机械手系统的关节位移信号与所述期望运动位移信号进行相减运算,并将运算结果分别输入所述RBF神经网络运算器、所述计算转矩控制器。
3.如权利要求2述的带干扰观测器的机械手神经网络控制系统,其特征在于,
所述第二加法运算器将所述机械手系统的关节速度信号与所述机械手系统的期望运动速度信号进行相减运算,并将运算结果分别输入所述RBF神经网络运算器、所述计算转矩控制器。
4.如权利要求2所述的带干扰观测器的机械手神经网络控制系统,其特征在于,
所述RBF神经网络运算器分别获取所述第一加法运算器、所述第二加法运算器的结果后进行计算处理,获取所述机械手系统的动力学不确定项;所述计算转矩控制器分别获取所述第一加法运算器、所述第二加法运算器的结果后进行计算处理,获取所述机械手系统的标称控制力矩;
所述干扰观测器获取所述第三加法运算器的输出的机械手系统的关节控制力矩、所述机械手系统第二输出端输出的机械手系统的关节速度信号,计算出该机械手系统的扰动项估计值;
所述第三加法运算器将所述RBF神经网络运算器输出的机械手系统的动力学不确定项、所述计算转矩控制器输出的机械手系统的标称控制力矩及所述干扰观测器输出的机械手系统的扰动项估计值进行相加运算,从而获取所述机械手系统的关节控制力矩;并将该机械手系统的关节控制力矩信号发送至所述机械手系统的输入端。
5.一种带干扰观测器的机械手神经网络控制系统的控制方法,其特征在于,该控制方法包含:
S1,建立带干扰观测器的机械手神经网络控制系统的动力学模型;所述步骤S1包含:
S1.1,现有机械手系统的动力学方程为:
其中,q,和分别表示所述机械手系统的关节的位移、速度和加速度矢量,M(q)∈Rn×n为对称正定的惯量矩阵,为离心力和哥氏力矢量,G(q)∈Rn为重力矢量,d表示外部扰动项,τ是所述机械手系统的关节控制力矩;
S1.2,由于现有所述机械手系统存在参数测量误差、外部环境以及负载的变化,很难获得精确的机械手动力学模型,模型中通常存在不确定性和外部干扰;因此带干扰观测器的机械手神经网络控制系统,将机械手动力学模型分为标称模型及动力学模型不确定项;
其中,标称模型的参数矩阵为:M0(q),G0(q),动力学模型不确定项的参数矩阵为:△M(q),和△G(q);则:
△M(q)=M0(q)-M(q) (2);
△G(q)=G0(q)-G(q) (4)
S2,针对所述步骤S1中动力学模型的标称模型部分,采用第一加法运算器、第二加法运算器及计算转矩控制器计算标称控制力矩;所述步骤S2包含:
S2.1,所述第一加法运算器将所述机械手系统的关节位移信号q与期望运动位移信号qd进行相减运算,获取所述机械手系统的位置跟踪误差e:
e=q-qd (5);
将该位置跟踪误差e分别输入RBF神经网络运算器、所述计算转矩控制器中;
S2.2,所述第二加法运算器将所述机械手系统的关节速度信号与所述机械手系统的期望运动速度信号进行相减运算,获取所述机械手系统的速度跟踪误差
将该速度跟踪误差分别输入所述RBF神经网络运算器、所述计算转矩控制器中;
S2.3,根据所述式(2)-式(6),所述计算转矩控制器计算标称控制力矩:
其中,kv为微分控制增益值;kp为比例控制增益值;
S3,当不考虑外部干扰时,采用所述第一加法运算器、所述第二加法运算器及RBF神经网络运算器计算出所述步骤S1中动力学模型的动力学不确定项;
所述步骤S3包含:
S3.1,根据式(1)、式(7)可得到:
其中,表示为所述步骤S1中动力学模型的动力学不确定项;
在不考虑外部干扰时,式(8)可改写为:
S3.2,令则误差方程(9)可写成如下状态空间形式
其中,
采用所述RBF神经网络运算器估算所述机械手系统不确定的动力学参数引起的动力学不确定项f(x);
S4,当考虑外部干扰时,为减少外部干扰对机械手系统的影响,采用第三加法运算器、干扰观测器计算出该机械手系统的扰动项估计值;
S5,根据所述步骤S4,对带有干扰观测器的机械手神经网络控制系统的动力学模型的扰动项估计值进行稳定性分析判断。
6.如权利要求5所述的带干扰观测器的机械手神经网络控制系统的控制方法,其特征在于,所述步骤S4包含:
S4.1,在不考虑所述步骤S1中动力学模型的动力学不确定项时,式(1)可改写为:
令则式(10)可写为:
S4.2,所述干扰观测器获取所述第三加法运算器的输出的机械手系统的关节控制力矩τ、所述机械手系统第二输出端输出的机械手系统的关节速度信号计算出该机械手系统的扰动项估计值:
其中,将式(12)代入式(13)可得:
其中,为对扰动项d'的估计值,是对的估计值;k1、k2为常数,并且k1>0,k2>0。
7.如权利要求5所述的带干扰观测器的机械手神经网络控制系统的控制方法,其特征在于,所述步骤S5包含:
S5.1,定义所述机械手系统的李雅普诺夫函数V:
其中,
则可知:
假设d为慢时变干扰,则很小,当取较大的k1值时,有
S5.2,将式(13)、式(14)及式(17)代入式(16)可得:
可知,所述干扰观测器能够对扰动项d'进行有效观测,从而实现补偿。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201510561545.4A CN105159084B (zh) | 2015-09-06 | 2015-09-06 | 一种带干扰观测器的机械手神经网络控制系统及方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201510561545.4A CN105159084B (zh) | 2015-09-06 | 2015-09-06 | 一种带干扰观测器的机械手神经网络控制系统及方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN105159084A CN105159084A (zh) | 2015-12-16 |
CN105159084B true CN105159084B (zh) | 2018-10-16 |
Family
ID=54799972
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201510561545.4A Active CN105159084B (zh) | 2015-09-06 | 2015-09-06 | 一种带干扰观测器的机械手神经网络控制系统及方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN105159084B (zh) |
Families Citing this family (12)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106983589B (zh) * | 2017-04-07 | 2018-07-31 | 河北工业大学 | 一种基于干扰观测器的主动型膝上假肢终端滑模控制方法 |
CN108189037B (zh) * | 2018-01-18 | 2021-04-06 | 中南大学 | 一种基于扰动观测器的机械手主次协调控制方法 |
CN108227506A (zh) * | 2018-02-08 | 2018-06-29 | 常州普旺科技有限公司 | 一种基于自适应最优化方法的机器人导纳控制系统 |
CN108406779A (zh) * | 2018-05-18 | 2018-08-17 | 昆明理工大学 | 一种基于未知输入观测器的机械臂运动控制方法 |
CN108673502A (zh) * | 2018-05-18 | 2018-10-19 | 昆明理工大学 | 一种基于未知模型动态观测器的机械臂运动控制方法 |
CN108942924B (zh) * | 2018-06-25 | 2021-07-13 | 南京理工大学 | 基于多层神经网络的模型不确定性机械臂运动控制方法 |
CN110488608B (zh) * | 2019-08-14 | 2022-05-27 | 深圳市烨嘉为技术有限公司 | 用于驱控一体化控制系统的智能化动力学参数辩识方法及模块 |
CN111015649B (zh) * | 2019-10-12 | 2020-12-25 | 深圳先进技术研究院 | 一种驱控一体化控制系统 |
CN111482958A (zh) * | 2019-12-13 | 2020-08-04 | 上海智殷自动化科技有限公司 | 基于神经网络的多传输机械手光刻机及其协同控制系统 |
CN111772794B (zh) * | 2020-06-29 | 2023-06-23 | 郑州大学 | 用于微创手术的主端、从端机器人控制方法与装置 |
CN112947071B (zh) * | 2021-01-28 | 2022-04-01 | 河北工业大学 | 基于Backstepping的下肢外骨骼控制方法 |
CN115890735B (zh) * | 2023-02-09 | 2023-05-05 | 四川大学华西医院 | 机械臂系统、机械臂及其控制方法、控制器和存储介质 |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US5804940A (en) * | 1994-04-08 | 1998-09-08 | Siemens Aktiengesellschaft | Device designed to compensate for non-linearity of machine shafts |
CN102501251A (zh) * | 2011-11-08 | 2012-06-20 | 北京邮电大学 | 带有动态摩擦补偿的机械臂关节定位控制方法 |
CN104216284A (zh) * | 2014-08-14 | 2014-12-17 | 浙江工业大学 | 机械臂伺服系统的有限时间协同控制方法 |
-
2015
- 2015-09-06 CN CN201510561545.4A patent/CN105159084B/zh active Active
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US5804940A (en) * | 1994-04-08 | 1998-09-08 | Siemens Aktiengesellschaft | Device designed to compensate for non-linearity of machine shafts |
CN102501251A (zh) * | 2011-11-08 | 2012-06-20 | 北京邮电大学 | 带有动态摩擦补偿的机械臂关节定位控制方法 |
CN104216284A (zh) * | 2014-08-14 | 2014-12-17 | 浙江工业大学 | 机械臂伺服系统的有限时间协同控制方法 |
Non-Patent Citations (3)
Title |
---|
基于非线性干扰观测器的BTT导弹自适应神经网络控制;王通,等;《第三十二届中国控制会议》;20130728;摘要 * |
机械臂自适应鲁棒轨迹跟踪控制;王三秀,等;《控制工程》;20150331;第22卷(第2期);摘要,第2-4节 * |
空间机械臂关节运动的自适应模糊补偿控制;梁捷,等;《系统仿真学报》;20110331;第23卷(第3期);第578-580页以及图2 * |
Also Published As
Publication number | Publication date |
---|---|
CN105159084A (zh) | 2015-12-16 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN105159084B (zh) | 一种带干扰观测器的机械手神经网络控制系统及方法 | |
CN109927032B (zh) | 一种基于高阶滑模观测器的机械臂轨迹跟踪控制方法 | |
CN105563489B (zh) | 基于非线性自抗扰控制技术的柔性机械臂控制方法 | |
CN106773713B (zh) | 针对欠驱动海洋航行器的高精度非线性路径跟踪控制方法 | |
CN112817231B (zh) | 一种具有强鲁棒性的机械臂高精度跟踪控制方法 | |
CN106483964B (zh) | 一种基于接触力观测器的机器人柔顺控制方法 | |
CN108628172B (zh) | 一种基于扩张状态观测器的机械臂高精度运动控制方法 | |
CN108614426A (zh) | 一种基于干扰观测器的多移动机器人编队鲁棒控制方法 | |
CN106647267B (zh) | 带有不确定动力学的吊车有限时间轨迹跟踪控制器及方法 | |
CN105045103B (zh) | 一种基于LuGre摩擦模型伺服机械手摩擦补偿控制系统及方法 | |
CN107561935A (zh) | 基于多层神经网络的电机位置伺服系统摩擦补偿控制方法 | |
CN112904728A (zh) | 一种基于改进型趋近律的机械臂滑模控制轨迹跟踪方法 | |
CN111965976B (zh) | 基于神经网络观测器的机器人关节滑模控制方法及系统 | |
CN112207834B (zh) | 一种基于干扰观测器的机器人关节系统控制方法及系统 | |
CN115586724B (zh) | 一种齿轮巡检机器人系统自适应分数阶全局滑模控制方法 | |
CN107193211B (zh) | 基于自抗扰和反演技术的单臂机械手控制器及其设计方法 | |
CN111941432A (zh) | 一种高性能机械臂人工智能输出反馈控制方法 | |
CN110286595B (zh) | 一类受饱和非线性输入影响的分数阶系统自适应控制方法 | |
CN113589689A (zh) | 一种基于多参数自适应神经网络的滑模控制器设计方法 | |
CN112859600B (zh) | 一种基于扩张状态观测器的机械系统有限时间控制方法 | |
CN113297798B (zh) | 一种基于人工神经网络的机器人外界接触力估计方法 | |
CN107765548B (zh) | 基于双观测器的发射平台高精度运动控制方法 | |
Hua et al. | Visual tracking control for an uncalibrated robot system with unknown camera parameters | |
CN109857127B (zh) | 训练神经网络模型以及飞行器姿态解算的方法、装置 | |
CN103197558B (zh) | 基于t-s模型的微陀螺仪模糊自适应控制方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
CB02 | Change of applicant information | ||
CB02 | Change of applicant information |
Address after: No. 605, Dongfang Road, Linghai City, Taizhou, Zhejiang Province, Zhejiang Applicant after: Taizhou University Applicant after: Wang Sanxiu Address before: 318000 School of physics and electronic engineering, No. 1139, Jiaojiang District, Jiaojiang District, Zhejiang Province, School of physics and electronics Applicant before: Taizhou University Applicant before: Wang Sanxiu |
|
GR01 | Patent grant | ||
GR01 | Patent grant |