一种欠驱动高自由度机械臂被动关节角度调整方法技术

本发明专利技术实施例提供了一种欠驱动高自由度机械臂被动关节角度调整方法，实现了高自由度机械臂任一关节处于欠驱动状态时的角度调整，包括：通过对欠驱动高自由度机械臂进行模型重构，实现机械臂高自由度向仅包含主动关节和被动关节的低自由度机械臂的转化；采用拉格朗日方程建立模型重构机械臂主被动关节轴线处于任意相互位置时的动力学耦合关系；基于所建立的动力学耦合关系，通过控制主动关节运动，实现欠驱动高自由度机械臂被动关节的角度调整。根据本发明专利技术实施例提供的技术方案，可实现欠驱动高自由度机械臂被动关节的角度调整。

【技术实现步骤摘要】
一种欠驱动高自由度机械臂被动关节角度调整方法
本专利技术涉及一种欠驱动高自由度机械臂被动关节角度调整方法，属于欠驱动机械臂运动控制

技术介绍
随着科学技术的快速发展，具有操作灵活、精准度高等优点的高自由度机械臂已被广泛应用于工业生产、航空航天等领域。为了减小整体质量以提高工作效率，部分高自由度机械臂的个别关节不具有驱动单元。此外，用于太空探索的冗余度空间机械臂，由于工作环境的恶劣与关节结构的复杂，机械臂在长期服役过程中极有可能会发生关节故障，使关节失去驱动力矩的关节自由摆动故障就属于一种常见的空间机械臂关节故障类型。实现欠驱动关节的运动控制能够极大提升高自由度机械臂的工作效率，因此，开展高自由度机械臂欠驱动关节运动控制的相关研究，对机械臂在人类工业生产、太空探索等领域的应用有着不可估量的理论价值和现实意义。现有关于欠驱动关节的角度调整方法多针对主被动关节轴线相互平行的低自由度机械臂，考虑到欠驱动关节只能利用欠驱动机械臂的动力学耦合特性通过主动关节的运动进行被动调整，因此欠驱动关节也称为被动关节。对于高自由度机械臂而言，主动关节过多会极大增加被动关节控制难度，且主被动关节轴线相对位置具有任意性；因此，建立可实现主被动关节轴线处于任意相互位置的高自由度机械臂被动关节角度调整策略，对于提高欠驱动高自由度机械臂工作效率与质量至关重要。
技术实现思路
有鉴于此，本专利技术实施例提供了一种欠驱动高自由度机械臂被动关节角度调整方法，所提方法可为具有欠驱动关节的高自由度机械臂运动控制提供保障。上述欠驱动高自由度机械臂被动关节的角度调整过程中，用到的方法至少包括：依据欠驱动高自由度机械臂构型特征建立任一关节处于欠驱动状态的高自由度机械臂动力学模型，根据被动关节在机械臂所有关节中所处位置，选定一个用于调整被动关节运动的主动关节，将被动关节与所选主动关节之外的所有关节锁定，重新建立机械臂动力学模型以实现欠驱动机械臂高自由度向低自由度的转化。依据所建低自由度机械臂动力学模型，通过求解系统总动能与重力势能，完成欠驱动机械臂拉格朗日方程的推导，基于推导所得拉格朗日方程，通过考虑关节间摩擦力，建立欠驱动机械臂主被动关节轴线处于任意相互位置时的动力学耦合关系，另外，考虑到欠驱动机械臂主被动关节轴线相互位置关系多为垂直和平行两种情况，因此，在完成主被动关节轴线处于任意相互位置时动力学耦合关系建立的基础上，推导主被动关节轴线分别处于垂直和平行两种特殊相互位置关系时欠驱动机械臂的动力学耦合关系。依据PD控制方法确定欠驱动机械臂主动关节控制律，基于所建动力学耦合关系获得欠驱动机械臂被动关节的运动规律，通过控制主动关节的运动，实现欠驱动高自由度机械臂被动关节的角度调整。上述求解过程中，实现欠驱动机械臂高自由度向低自由度转化的过程包括：第一步：建立欠驱动n自由度机械臂动力学模型，所建模型对应的动力学参数符号定义介绍如表1所示：表1机械臂动力学参数符号定义符号定义符号定义Lk机械臂第k个连杆Σk连杆Lk的坐标系mk连杆Lk的质量rk连杆Lk的质心在坐标系Σk的矢量Jk-1连杆Lk-2和Lk-1间的关节rki连杆Li的质心在坐标系Σk的矢量lk-1关节Jk-1到Jk的矢量Jk机械臂欠驱动关节第二步：为了实现欠驱动高自由度机械臂被动关节的角度调整，应首先确定用于驱动被动关节运动的主动关节；考虑到主动关节与被动关节相邻时关节间的加速度及力矩等的耦合关系要比非相邻时的耦合关系更为明显，因此，当机械臂从基座开始计数的第一个关节J1为欠驱动关节时，选取与其相邻的第二个关节J2为主动关节；当机械臂非第一关节Jk为欠驱动关节时，考虑到前置关节Jk-1为主动关节时的加速度及力矩等的耦合关系要比后置关节Jk+1为主动关节时更为明显，因此，选取与欠驱动关节相邻的前置关节Jk-1为主动关节；第三步：基于模型重构建立仅包含主动关节和被动关节的欠驱动机械臂动力学模型；在选定欠驱动高自由度机械臂的主动关节Jk-1之后，锁定除主动关节Jk-1和被动关节Jk之外的所有关节，建立欠驱动二自由度机械臂动力学模型；设主动连杆La和被动连杆Lp对应的坐标系分别为Σa,Σp；建立操作空间的坐标系∑I′，∑I′的原点位置与各坐标轴方向同Σa或Σp的初始状态相同；连杆Lp内部任一连杆Li在坐标系Σp的质心矢量为rpi；令θk-1表示主动关节角度，θk表示被动关节角度，在各锁定关节的角度θ1,…,θk-2,θk+1,…,θn已知的基础上，基于DH法计算各连杆间的转换矩阵根据各连杆质心在自身坐标系Σi的矢量可得各连杆质心在基坐标系Σ0的矢量r0i可表示为：基于上式可求得被动连杆Lp内部各连杆Li(i＝k+1,k+2,...,n)的质心相对于坐标系Σp的矢量rpi如下：完成上述动力学参数的求解，即可实现欠驱动n自由度机械臂的模型重构，获得仅包含主动关节和被动关节的欠驱动二自由度机械臂，以实现机械臂高自由度向低自由度的转化。上述计算过程中，欠驱动机械臂主被动关节轴线处于任意相互位置时的动力学耦合关系的建立过程包括：第一步：基于模型重构所得欠驱动二自由度机械臂动力学参数，推导机械臂拉格朗日方程，建立欠驱动机械臂主被动关节轴线处于任意相互位置时的动力学耦合关系；当欠驱动机械臂主被动关节轴线处于任意相互位置时，根据动能定理求解机械臂系统动能Ek与重力势能P如下：上式中，(rpi)j表示向量rpi的第j项，α表示主被动关节轴线处于任意相互位置时的夹角，g表示重力加速度，dk表示机械臂DH参数中的偏置项，vi表示被动连杆Lp内任一连杆Li的质心和主动连杆La的质心相对于坐标系∑I′的线速度，且有其中：上式中：上式中，ak-1表示机械臂DH参数中的杆长项。在完成机械臂系统动能Ek与重力势能P求解的基础上，可进一步获得主被动关节轴线处于任意相互位置时欠驱动机械臂系统的拉格朗日函数如下：L＝Ek-P(5)基于拉格朗日函数，推导欠驱动机械臂主被动关节的广义力矩τa,τp如下：广义力矩由关节驱动提供的主动力矩τs和关节间摩擦力矩τf两部分构成，即：τ＝τs+τf(7)在被动关节角度调整过程中，被动关节提供的主动力矩τs＝0；由于关节间摩擦力矩τf与被动关节角速度有关，因此建立粘性摩擦模型如下：上式中，μ表示粘性摩擦因数，基于上式可将被动关节的驱动力矩τp转化为：根据机械臂系统的拉格朗日函数完成上式中和的求解，将求解结果代入上式，即可获得欠驱动机械臂主被动关节轴线处于任意相互位置时的动力学耦合关系：上式中，与表示向心加速度系数，表示科氏加速度系数，表示被动关节处的重力影响项，J11与J22分别表示主、被动关节的有效惯量，J12表示主被动关节间的耦合惯量，且有：第二步：基于欠驱动机械臂主被动关节轴线处于任意相互位置时的动力学耦合关系，建立主被动关节轴线处于垂直这一特殊相互位置时的欠驱动机械臂动力学耦合关系；令主被动关节轴线相互垂直，即使主被动关节轴线间夹角α＝90°，将其代入第一步中所求机械臂系统动能Ek与重力势能P的表达式，可得主被动关节轴线相互垂直时机械臂系统动能与重力势能Pver的具体表达如下：上式中，vk-1表示关节Jk-1的线速度，令D＝(dk+(rpi)3)1/2，则线速度vi可表示为：在本文档来自技高网...

【技术保护点】
一种欠驱动高自由度机械臂被动关节角度调整方法，其特征在于该方法包括以下步骤：(1)依据被动关节在机械臂所有关节中所处位置，选定用于调整被动关节运动的主动关节，基于模型重构完成欠驱动机械臂高自由度向仅包含主动关节和被动关节的低自由度机械臂的转化；(2)建立低自由度欠驱动机械臂动力学模型，基于拉格朗日方程推导欠驱动机械臂主被动关节轴线处于任意相互位置时的动力学耦合关系，并建立主被动关节轴线处于垂直和平行两种特殊相互位置时的动力学耦合关系。

【技术特征摘要】
1.一种欠驱动高自由度机械臂被动关节角度调整方法，其特征在于该方法包括以下步骤：(1)依据被动关节在机械臂所有关节中所处位置，选定用于调整被动关节运动的主动关节，基于模型重构完成欠驱动机械臂高自由度向仅包含主动关节和被动关节的低自由度机械臂的转化；(2)建立低自由度欠驱动机械臂动力学模型，基于拉格朗日方程推导欠驱动机械臂主被动关节轴线处于任意相互位置时的动力学耦合关系，并建立主被动关节轴线处于垂直和平行两种特殊相互位置时的动力学耦合关系。2.根据权利要求1所述的方法，其特征在于，实现欠驱动机械臂高自由度向低自由度转化的过程至少包括：(1)建立欠驱动n自由度机械臂动力学模型，若第一关节J1为被动关节，则选定第二关节J2为主动关节，否则，选定被动关节Jk的前置关节Jk-1为主动关节；(2)将除主动关节Jk-1和被动关节Jk之外的所有关节J1,…,Jk-2,Jk+1,…,Jn锁定；(3)基于各锁定关节角度θ1,…,θk-2,θk+1,…,θn，各连杆质心相对于自身坐标系的矢量等已知参数，求解欠驱动机械臂被动连杆Lp内部各连杆Li(i＝k+1,k+2,…,n)的质心相对于坐标系Σp的矢量rpi等参数，实现欠驱动机械臂高自由度向仅包含主动关节和被动关节的低自由度机械臂的转化。3.根据权利要求1所述的方法，其特征在于，建立欠驱动机械臂主被动关节轴线处于任意相互位置的动力学耦合关系的过程至少包括：(1)基于拉格朗日方程建立欠驱动机械臂主被动关节轴线处于任意相互位置时的动力学耦合关系：

【专利技术属性】
技术研发人员：陈钢，王宣，贾庆轩，符颖卓，袁博楠，闫硕，
申请(专利权)人：北京邮电大学，
类型：发明
国别省市：北京,11