基于柔性液压机械臂雅可比矩阵的末端力软测量方法技术

本发明专利技术公开了基于柔性液压机械臂雅可比矩阵的末端力软测量方法，其方法包括：首先建立柔性液压机械臂动力学模型，建立非线性关节摩擦力矩模型，建立柔性臂最小惯性参数集及其对应的回归矩阵的线性模型，生成激励轨迹；然后运行一次激励轨迹，根据得到的液压驱动力矩τ和回归矩阵Y计算机械臂动力学参数；然后通过倾角传感器测得数据，求解出臂杆末端挠度变形解析式，通过对柔性液压机械臂末端位置基于关节角度求偏导可得柔性臂的雅可比矩阵；最后，通过辨识所得的柔性臂动力学参数结合柔性臂雅可比矩阵，可计算出柔性液压机械臂末端力；本发明专利技术提出的末端力软测量方法可以解决柔性液压机械臂因臂杆变形造成末端力估计不准的问题。的问题。的问题。

【技术实现步骤摘要】
基于柔性液压机械臂雅可比矩阵的末端力软测量方法


[0001]本专利技术涉及柔性液压机械臂控制
，具体涉及基于柔性液压机械臂雅可比矩阵的末端力软测量方法。

技术介绍

[0002]目前柔性液压机械臂已被广泛应用于大飞机清洗和隧道凿岩等接触性作业，面对多变的非结构化环境，以及柔性液压机械臂自身的惯量大，经常性接触容易造成末端力传感器的损坏，对末端力的测量造成影响。
[0003]目前已经有基于参数辨识的液压机械臂末端力软测量方法，例如专利公开号为CN113977578A，名为一种液压机械臂末端力软测量方法，为本团队2021年10月26日申请且以获得授权的专利，但此种末端力软测量方法只适用于刚性液压机械臂，柔性液压机械臂在运行过程中因为自身臂架结构的变形特性，动态特性难以描述，导致液压机械臂动力学参数存在不准确的问题，因此对于存在臂杆变形的长柔性多关节液压机械臂并不适用，未考虑臂杆变形对机械臂末端力软测量的影响。当柔性液压机械臂末端受力时，可将其等效为液压缸的受力，由液压缸驱动力矩克服末端负载力，故可利用雅克比矩阵将末端力分解到各关节上。但因为臂杆柔性产生的挠度变形会对转换的雅可比矩阵产生影响，直接用未考虑挠度变形的刚性雅可比矩阵会导致末端力计算结果不准。因此，考虑柔性臂杆变形特性，提出一种根据各臂杆挠度变形求解柔性臂雅可比矩阵的方法。基于柔性臂雅可比矩阵，提出基于柔性液压机械臂雅可比矩阵的末端力软测量方法，可以解决因臂杆变形造成末端力估计不准的问题。

技术实现思路

[0004]为此，本专利技术提供基于柔性液压机械臂雅可比矩阵的末端力软测量方法，通过建立柔性臂动力学模型，关节摩擦采用非线性关节摩擦模型，进而建立柔性臂最小惯性参数集模型。利用有限傅里叶级数求解激励轨迹，在激励轨迹下利用最小惯性参数集模型求解柔性臂动力学参数，通过倾角传感器计算柔性臂杆挠度变形解析式，根据柔性臂运动学特性，求解出含有臂杆末端挠度的柔性臂雅可比矩阵，进而计算外部作用力。
[0005]本专利技术采用的技术方案是：基于柔性液压机械臂雅可比矩阵的末端力软测量方法，包括以下步骤：
[0006]步骤1，建立柔性液压机械臂动力学模型，针对柔性液压机械臂运动范围广、关节摩擦不精确等问题，建立非线性关节摩擦力矩模型，根据柔性臂动力学模型确定三关节柔性臂液压驱动力矩与广义力之间的关系，并将动力学模型线性化处理，建立柔性臂最小惯性参数集及其对应的回归矩阵的线性模型；
[0007]步骤2，利用有限傅里叶级数设计激励轨迹，以步骤1的回归矩阵条件数最小为目标，求解有限傅里叶级数系数，生成激励轨迹；
[0008]步骤3，柔性臂在无负载条件下，运行一次激励轨迹，采集液压缸两腔压力传感器
数值，并通过液压缸两腔压力计算液压驱动力矩τ；将各时刻的广义模态角度(含关节角度与模态参数)、广义角速度、广义角加速度带入回归矩阵Y中，并合并成一个总矩阵；
[0009]步骤4，根据步骤3得到的液压驱动力矩τ和回归矩阵Y计算柔性臂动力学参数；
[0010]步骤5，通过安装在臂段三处的倾角传感器以及臂杆首端(靠近基座端点)倾角传感器共4个倾角传感器测得数据，求解出臂杆末端挠度变形解析式；
[0011]步骤6，通过分析三自由度柔性臂运动学特性，求解柔性臂末端位置，通过末端位置对关节角度求偏导以及结合步骤5中求解出来的臂杆末端挠度变形解析式可求解出含有挠度变形的柔性臂雅可比矩阵；
[0012]步骤7，将步骤4中所得的动力学参数，带入到步骤1的线性模型中，结合步骤6中柔性臂雅可比矩阵计算柔性液压机械臂末端力大小；
[0013]进一步地，步骤1中所建立的柔性液压机械臂动力学模型具体如下：
[0014][0015]其中，p为柔性臂广义角度，p＝[θ q]T
，θ为关节角度，q为模态坐标，为广义角速度，为广义角加速度，τ为液压驱动力矩，M(p)为柔性臂惯性矩阵，为柔性臂科氏力和向心力矩阵，K为柔性臂刚度矩阵，G为柔性臂重力矩阵，τ
f
为非线性关节摩擦力矩。
[0016]进一步地，步骤1中所建立的非线性关节摩擦力矩模型为：
[0017][0018]其中，k1、k2、k3、k4是傅里叶级数的系数，k5、k6、k7、k8是三阶多项式的系数，为待辨识参数。
[0019]进一步地，步骤1中所述的柔性臂液压驱动力矩与柔性臂所受的广义力之间的关系为：
[0020]Q
I
＝τ
i
‑
τ
i+1
[0021]其中，Q
I
为柔性臂所受的广义力，下标I为广义力序号，τ
i
为柔性臂所受的关节力矩，下标i为关节序号。
[0022]进一步地，步骤1中所述的柔性臂最小惯性参数集线性模型具体如下：
[0023][0024]其中，表示回归矩阵，L表示最小惯性参数集。
[0025]进一步地，步骤2中所述的有限傅里叶级数表达式如下：
[0026][0027]对于第i个关节，正弦项和余弦项的数目均为N，t表示激励轨迹的运行时间，ω
f
＝2πf
f
为基频，f
f
＝1/t，a
l，i
、b
l，i
、θ
i0
为待求傅里叶系数，用含约束条件的多元函数求最优的方法求解。为了保证机器人平稳且在能够到达的安全范围之内运行，约束条件如下：
[0028][0029]其中，cond
min
(Y)表示以回归矩阵Y的条件数最小为优化目标，θ(t)表示t时刻的柔性臂关节角度；θ0为柔性臂初始关节角，当一个周期结束时，t＝t
f
，t
f
表示终止时刻，柔性臂回到柔性臂初始关节角θ0，从而能够连续执行下一周期，初始t＝0和结束t＝t
f
的速度和加速度设为0，有效避免冲击；θ
min
、θ
max
、分别为机械臂运动时角度、角速度和角加速度的最小值和最大值；通过限定角度、角速度、角加速度上下限，保证柔性臂在安全的范围内运动。
[0030]进一步地，步骤3中所述的回归矩阵Y合并的矩阵，是先计算出各个时刻下的回归矩阵Y
k
，k为时间间隔点数，再将所有回归矩阵Y
k
合并成一个总矩阵Y：
[0031][0032]进一步地，步骤3中所述的实际液压驱动力矩τ
i
为：
[0033]τ
i
＝(P
ai
A
ai
‑
P
bi
A
bi
)
·
r
i
[0034]其中，i是关节序号，P
ai
，P
bi
为液压缸无杆腔和有杆腔压力，由压力传感器测得，A
ai
，A
bi
本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.基于柔性液压机械臂雅可比矩阵的末端力软测量方法，其特征在于，包括以下步骤：步骤1，建立柔性液压机械臂动力学模型，针对柔性液压机械臂运动范围广、关节摩擦不精确等问题，建立非线性关节摩擦力矩模型，根据柔性臂动力学模型确定柔性臂液压驱动力矩与广义力之间的关系，并将动力学模型线性化处理，建立柔性臂最小惯性参数集及其对应的回归矩阵的线性模型；步骤2，利用有限傅里叶级数设计激励轨迹，以步骤1的回归矩阵条件数最小为目标，求解有限傅里叶级数系数，生成激励轨迹；步骤3，柔性臂在无负载条件下，运行一次激励轨迹，采集液压缸两腔压力传感器数值，并通过液压缸两腔压力计算液压驱动力矩τ；将各时刻的广义模态角度(含关节角度与模态参数)、广义角速度、广义角加速度带入回归矩阵Y中，并合并成一个总矩阵；步骤4，根据步骤3得到的液压驱动力矩τ和回归矩阵Y计算柔性臂动力学参数；步骤5，通过安装在臂段三处的倾角传感器以及臂杆首端(靠近基座端点)倾角传感器共4个倾角传感器测得数据，求解出臂杆末端挠度变形解析式；步骤6，通过分析三自由度柔性臂运动学特性，求解柔性臂末端位置，通过对末端位置中关节角度求偏导以及结合步骤5中求解出来的臂杆末端挠度变形解析式可求解出含有挠度变形的柔性臂雅可比矩阵；步骤7，将步骤4中所得的动力学参数，带入到步骤1的线性模型中，结合步骤6中柔性臂雅可比矩阵计算柔性液压机械臂末端力大小；其中，F为机械臂末端力；J(p)是柔性液压机械臂雅克比矩阵，表示回归矩阵，L表示最小惯性参数集，τ
f
为非线性关节摩擦力矩。2.根据权利要求1所述的基于柔性液压机械臂雅可比矩阵的末端力软测量方法，其特征在于，步骤1中所述的柔性液压机械臂动力学模型具体如下：其中，p为柔性臂广义模态角，p＝[θ q]
T
，θ为关节角度，q为模态坐标，为广义角速度，为广义角加速度，τ为液压驱动力矩，M(p)为柔性臂惯性矩阵，为柔性臂科氏力和向心力矩阵，K为柔性臂刚度矩阵，G为柔性臂重力矩阵，τ
f
为非线性关节摩擦力矩。3.根据权利要求1所述的基于柔性液压机械臂雅可比矩阵的末端力软测量方法，其特征在于，步骤1中所建立的非线性关节摩擦力矩模型为：其中，k1、k2、k3、k4是傅里叶级数的系数，k5、k6、k7、k8是三阶多项式的系数，为待辨识参数。4.根据权利要求1所述的基于柔性液压机械臂雅可比矩阵的末端力软测量方法，其特征在于，步骤1中所述的柔性臂液压驱动力矩与柔性臂所受的广义力之间的关系为：Q
I
＝τ
i
‑
τ
i+1
其中，Q
I
为柔性臂所受的广义力，下标I为广义力序号，τ
i
为柔性臂所受的关节力矩，下
标i为关节序号。5.根据权利要求1所述的基于柔性液压机械臂雅可比矩阵的末端力软测量方法，其特征在于，步骤1中所述的柔性臂最小惯性参数集线性模型具体如下：其中，表示柔性臂回归矩阵，L表示最小惯性参数集。6.根据权利要求1所述的基于柔性液压机械臂雅可比矩阵的末端力软测量方法，其特征在于，步骤2中所述的有限傅里叶级数表达式如下：对于第i个关节，正弦项和余弦项的数目均为N，t表示激励轨迹的运行时间，ω
f
＝2πf
f
为基频，f
f
＝1/t，a
l,i
...

【专利技术属性】
技术研发人员：丁孺琦，李锋，李刚，曾礼平，
申请(专利权)人：华东交通大学，
类型：发明
国别省市：