技术特征：
1.一种基于全状态反馈的机器人关节高精度控制系统，其特征在于，该控制系统包括状态观测器、机器人关节摩擦模型、速度调节器、第一比例调节器、第二比例调节器、第一至第三反相加法器、同相加法器；状态观测器，其基于机器人关节的等效动力学模型构造，其输入检知的关节运转位置数据和未给与摩擦补偿的控制信号，其输出传动系统输出侧变量的估计值；其包括第一输出端和第二输出端，其第一输出端输出速度相关变量估计值，其第二输出端输出关节受到的等效扰动变量估计值；机器人关节摩擦模型，其输入关节速度指令信号或在传动系统输出侧检知的速度信号；其输出等效摩擦力估计值或等效摩擦力矩估计值；第一反相加法器，其正极输入端输入指令信号向量，其负极输入端之一输入传动系统输出侧检知的位置信号，其负极输入端之二与状态观测器的第一输出端相连；其输出端与第一比例调节器的输入端相连，第一比例调节器的输出端与第二反相加法器的正极输入端相连；第二反相加法器的负极输入端输入驱动关节转动的电机的输出轴检知的角速度信号；第二反相加法器的输出端与速度调节器的输入端相连，速度调节器的输出端与第三反相加法器的正极输入端相连；第三反相加法器的负极输入端与第二比例调节器的输出端相连；第二比例调节器的输入端与状态观测器的第二输出端相连；第三反相加法器的输出端分别与同相加法器的输入端之一和状态观测器的输入端之一相连；同相加法器的输入端之二与机器人关节摩擦模型的输出端相连；同相加法器的输出端输出驱动关节转动的电机转矩指令。2.根据权利要求1所述的基于全状态反馈的机器人关节高精度控制系统，其特征在于，状态观测器为对全阶状态观测器进行降阶处理的降阶扩张状态观测器，其第一输出端输出传动系统输出侧的速度、加速度及加加速度变量估计值。3.根据权利要求2所述的基于全状态反馈的机器人关节高精度控制系统，其特征在于，设：i为传动系统的传动比，iθ为关节电机的输入位置指令信号，为关节电机的输入指令信号向量；k
o
＝(k
1 k
2 k
3 k4)为第一比例调节器的增益矩阵，k1表示位置反馈增益，k2表示速度反馈增益，k3表示加速度反馈增益，k4表示加加速度反馈增益，g为关节受到的扰动变量，v为速度调节器的输出信号，w1为传动系统输出侧的能直接检测的位置信号，w2为传动系统输出侧的不能直接检测的速度、加速度、加加速度信号；为w2的估计值，为扰动变量g的估计值，α为反馈信号的增益系数，为通过机器人关节摩擦模型预估得到的摩擦力,为关节电机转子的速度信号；设速度调节器采用pi控制，使速度调节器的输入信号为将和w1作为降阶扩张状态观测器的输入信号，降阶扩张状态观测器的输出信号包括和使成为扰动及摩擦力综合补偿后的电机转矩指令。4.根据权利要求3所述的基于全状态反馈的机器人关节高精度控制系统，其特征在于，设为关节电机的输入速度指令信号，当驱动关节弹性较小时，将作为机器人关节摩擦模型的输入信号。5.根据权利要求3所述的基于全状态反馈的机器人关节高精度控制方法，其特征在于，
设为中传动系统输出侧速度信号的估计值，当驱动关节弹性较大时，将作为机器人关节摩擦模型的输入信号。6.一种基于全状态反馈的机器人关节高精度控制方法，其特征在于，建立机器人关节的等效动力学模型，基于该等效动力学模型，利用检知的关节运转位置数据及已知的关节参数构造状态观测器，采用状态观测器得到如下变量的估计值：传动系统输出侧的速度相关变量估计值以及关节受到的等效扰动；采用以位置控制环为外环、以速度控制环为内环的双闭环全状态反馈的控制方法，在位置控制环中设置第一比例调节器，在速度控制环中设置速度调节器；将传动系统输出侧的实测位置信号以及状态观测器输出的速度相关变量估计值作为控制系统的位置控制环反馈信号，将状态观测器输出的关节受到的等效扰动估计值补偿到控制系统的速度控制环的输出信号中，对关节运转中的扰动进行补偿；同时建立机器人关节摩擦模型，对机器人关节摩擦模型的参数进行辨识，由输入的关节速度指令信号或在传动系统输出侧检知的速度信号，通过机器人关节摩擦模型估计得到等效摩擦力或等效摩擦力矩；将估计得到的等效摩擦力或等效摩擦力矩，补偿到驱动关节转动的电机转矩指令信号中，对摩擦力给与补偿。7.根据权利要求6所述的基于全状态反馈的机器人关节高精度控制方法，其特征在于，状态观测器采用对全阶状态观测器进行降阶处理的降阶扩张状态观测器，其第一输出端输出传动系统输出侧的速度、加速度及加加速度变量估计值。8.根据权利要求7所述的基于全状态反馈的机器人关节高精度控制方法，其特征在于，利用已知的关节信息构造降阶扩张状态观测器的方法包括如下步骤：步骤1，建立如下机器人驱动关节的等效动力学模型：式(1)中：步骤2，将式(1)转换为下式(2)：式中，i1为电机转子的转动惯量；i2为传动系统及机械系统的等效转动惯量；c1为电机转子的摩擦阻尼；c2为等效负载的摩擦阻尼；i为传动系统的传动比；k为传动系统的等效刚度；θ1为电机转子转角；θ2为传动系统输出侧的位置信号；τ1为电机的电磁力矩；τ2为等效至传动系统输出侧的负载力矩；b0为机器人驱动关节的增益系数，y为传动系统输出侧的位置，θ
2(4)
为θ2的4阶导数，u为控制输入，τ
w
为系统受到的时变扰动以及非线性环节引起的扰动变量，a
j
(j＝0,1,2,3)为与机器人驱动关节物理量相关的系数；步骤3，将式(2)转化为下式(3)所示的状态空间形式：式(3)中：x1＝θ2，x5＝τ
w
，x＝(x
1 x
2 x
3 x
4 x5)
t
；
步骤4，设x
o1
为x中可以直接测得的状态变量θ2，x
o2
为x中不能直接获得的状态变量以及扰动变量，令式(3)转化为下式(4)：式中，a
o11
＝0，a
o12
＝(1 0 0 0)，b
o1
＝0，b
ow1
＝0，c
o1
＝1，c
o2
＝(0 0 0 0)；步骤5，根据式(4)所示的状态方程，按下式(5)得到x
o2
的观测值从而得到τ
w
的估计值值式中，l＝(β
1 β
2 β
3 β4)
t
为降阶扩张状态观测器的增益矩阵，β1为与速度估计值相关的增益，β2为与加速度估计值相关的增益，β3为与加加速度估计值相关的增益，β4为与扰动变量估计值相关的增益。9.根据权利要求8所述的基于全状态反馈的机器人关节高精度控制方法，其特征在于，对关节运转中的扰动进行补偿的方法包括：设：u0为速度调节器的输出信号，u为速度调节器的输出信号经降阶扩张状态观测器进行扰动补偿后的信号，x为传动系统输出侧的状态变量,x
o1
为传动系统输出侧的能直接检测的状态变量θ2，为传动系统输出侧的不能直接检测的状态变量以及扰动变量，为x
o2
的估计值，为扰动状态τ
w
的估计值，b0为反馈信号的增益系数；为通过机器人关节摩擦模型预估得到的摩擦力；将中的扰动观测量补偿到速度调节器
的输出信号u0中；使控制量为选取合适的降阶扩张状态观测器增益矩阵l，使得式(2)转化为下式(7)：此时，系统的扰动被抵消。10.根据权利要求6所述的基于全状态反馈的机器人关节高精度控制方法，其特征在于，建立如下机器人驱动关节的机器人关节摩擦模型：于，建立如下机器人驱动关节的机器人关节摩擦模型：式中，τ
f
为摩擦力矩；τ
e
为外部力矩；τ
s
为最大静摩擦力矩；τ
c
为库伦摩擦力矩；ω为机器人关节摩擦模型的输入速度信号；ω
s
为stribeck速度；b为粘滞摩擦系数。11.根据权利要求10所述的基于全状态反馈的机器人关节高精度控制方法，其特征在于，对机器人关节摩擦模型的参数进行辨识的方法包括：输入不同恒定速度指令，并测出不同恒定速度指令下关节稳定时的电机轴的摩擦力值；利用速度指令数据和对应的摩擦力数据对机器人关节摩擦模型进行拟合，辨识出机器人关节摩擦模型中的τ
s
、τ
c
、ω
s
和b。
技术总结
本发明公开了一种基于全状态反馈的机器人关节高精度控制系统，该控制系统包括状态观测器、机器人关节摩擦模型等；状态观测器基于机器人关节的等效动力学模型构造，其输入检知的关节运转位置数据和未给与摩擦补偿的控制信号，其输出传动系统输出侧变量的估计值；机器人关节摩擦模型输入关节速度指令信号或在传动系统输出侧检知的速度信号；输出等效摩擦力估计值或等效摩擦力矩估计值。本发明还公开了一种基于全状态反馈的机器人关节高精度控制方法，将降阶扩张状态观测器估计出的等效扰动补偿到电机的输入信号中，对驱动关节实施扰动补偿；由摩擦模型估计的摩擦力补偿到电机的输入力矩信号中，对摩擦力实施补偿。对摩擦力实施补偿。对摩擦力实施补偿。
技术研发人员：刘海涛 王岩 山显雷 黄田 肖聚亮
受保护的技术使用者：天津大学
技术研发日：2021.09.29
技术公布日：2021/12/16