CN112748741A - 一种不同姿态四足爬壁机器人的关节扭矩确定方法 - Google Patents

Abstract

本发明公开了一种不同姿态四足爬壁机器人的关节扭矩确定方法，包括：采用吸附姿态描述机器人吸附的姿态信息；确定其机器人吸附姿态和腿末端位置；基于力平移原理和质心公式将机器人重力集中处理，建立了在任意吸附姿态下机器人整体的力螺旋平衡方程；利用有限元分析建立腿支链子装配体的静柔度模型并通过线性变换得到任意吸附姿态下腿静柔度模型和腿末端的线变形，继而得到约束方程和求得足端力；在获得足端力后，经力学分析可得到不同姿态机器人的关节扭矩。本发明提出的一种不同姿态四足爬壁机器人的关节扭矩确定方法，可以快速得到机器人四足足端力和确定机器人各个关节的扭矩，可用于关节电机选型和校核，进一步加快机器人研发进程。

Description

一种不同姿态四足爬壁机器人的关节扭矩确定方法

技术领域

本发明属于机器人技术应用领域，具体涉及一种不同姿态四足爬壁机器人的关节扭矩确定方法。

背景技术

机器人关节扭矩是关节电机选型和校核的依据，在足端力确定后，可通过基本的力学知识转换确定。因而在机器人结构设计和研发阶段，足端力和关节扭矩的获得方式大体上分为两种：仿真分析和解析法求解。

仿真分析，是指通过将机器人三维模型导入计算机仿真软件，在计算机软件中驱动机器人运动和获得相应的足端力和关节扭矩数据。常用的仿真分析软件有ADAMS、Ansys等，通过软件仿真分析往往是获取足端力的常用手段，也是当前受力分析最为准确的方法。但存在不足的是，机器人姿态多样，利用仿真方法分析姿态变化的机器人足端力和关节扭矩会存在需要重复搭建仿真环境(或者重复画网格)而增加工作量的问题。

解析法求解，是指在机器人的三维模型基础上，将机器人关节、杆件简化得到简化模型，并利用结构力学和数学知识建立机器人力平衡方程组，通过求解包含足端力未知量的方程组获得足端力的大小，继而求解得到关节扭矩。但四足爬壁机器人3、4腿吸附时，机器人力平衡方程超静定，求解困难。并且当机器人腿重力占比较大时，不可忽略腿重力对足端力的影响，由于模型简化，解析法求解足端力会存在误差较大的问题，导致关节电机不匹配和吸附结构设计不合理的问题。

阮鹏等在《基于ADAMS的仿壁虎机器人步态规划及仿真[J].机器人,2010,32(04):499-504+509.(DOI：10.3724/SP.J.1218.2010.00499》中，通过ADAMS软件仿真分析得到四足爬壁机器人在对角步态时的足端力和关节扭矩，只考虑机器人某个姿态下的足端力和关节扭矩，缺乏考虑机器人在不同壁面上不同姿态的情况。针对机器人在不同壁面上不同姿态的情况，如果采用该文献中提到的ADAMS仿真分析方法，则需要重复搭建仿真环境，调整机器人姿态再导入ADAMS软件进行分析，获取不同姿态下四足爬壁机器人的关节扭矩的工作量较大。

发明内容

本发明的目的在于克服上述背景技术的不足，提供一种不同姿态四足爬壁机器人的节扭矩确定方法，结合运动学、静力学和有限元分析精准获得不同姿态下四足爬壁机器人的足端力，然后基于足端力获得关节扭矩，得到的关节扭矩可用于机器人关节电机的选型和校核，可加快机器人设计研发过程。

为了实现上述发明目的，本发明提供一种不同姿态四足爬壁机器人的关节扭矩确定方法，包括以下步骤：

在机器人多腿吸附时，采用吸附姿态描述机器人吸附的姿态信息，所述吸附姿态Q包括机器人的关节角度(θ_i1,θ_i2,θ_i3)、腰部姿态Q_t和各腿是否吸附的状态s_i，并确定所述机器人的关节角度、所述腰部姿态和所述各腿是否吸附的状态之间的关系；

通过运动学建模确定机器人吸附姿态和各腿的腿末端位置；

将机器人各部件的重力转移到腰部的几何中心，将重力集中处理，获得等效六维力F；

根据所述机器人的吸附姿态和所述等效六维力F，建立机器人整体力平衡方程；

将腿的结构导入有限元分析软件并利用有限元分析得到腿子装配体的静柔度模型；

基于子装配体的静柔度模型，由线性组合得到各腿的静柔度模型和线变形；

建立各腿线变形协调条件以增加额外的约束方程，并根据所述机器人整体力平衡方程和所述约束方程获得足端力；

基于所述足端力进行力学分析，获得机器人的关节扭矩。

进一步地，所述采用吸附姿态描述机器人吸附的状态信息，具体包括：

将机器人结构视为包括一个中间腰部D₁D₂D₃D₄和四条腿A_iB_iC_iD_iF_i(i＝1,2,3,4)，其中F_i、D_i、C_i分别为机器人第i腿的3个关节，并以中间腰部的中心为原点建立躯干世界坐标系O_bw；

所述机器人的关节角度(θ_i1,θ_i2,θ_i3)、所述腰部姿态Q_t和各腿是否吸附的状态s_i存在如下关系：

Q＝(Q₁,Q₂…,Q_i,Q_t) (1)

其中，Q_i＝(θ_i1,θ_i2,θ_i3,s_i)^T，Q_t＝(a_g,1)^T

式中，Q表示机器人吸附姿态，Q_i表示第i腿的状态，Q_t表示机器人腰部姿态，，(θ_i1,θ_i2,θ_i3)表示第i腿的3个关节处的关节角，s_i代表腿末端吸附状态，a_g表示重力加速度，上标T表示转置。

进一步地，所述通过运动学建模确定机器人吸附姿态和各腿的腿末端位置，具体步骤包括：

进行D-H建模，按照相邻关节转动轴的交点为坐标系原点、转动轴方向为坐标系Z轴、Z_i与Z_i-1的公垂线或者外积方向为X_i-1和右手螺旋的规则分别建立基于3个关节轴和腿部末端的坐标系O₁、O₂、O₃、O₄，

获得机器人单腿运动学方程：

式中，⁴P是点P在腿部末端坐标系O₄中的位置，^bwP表示点P在躯干世界坐标系O_bw下的位置，

表示由坐标系On变换到坐标系O_n-1(n＝1,2,3,4)的变换矩阵；

机器人其余三腿的位置可视为第2腿绕腰部中心旋转不同角度得到，基于所述机器人的关节角度、所述腰部姿态和所述各腿是否吸附的状态之间的关系，结合各腿的(θ_i1,θ_i2,θ_i3)参数，即可确定机器人吸附姿态；

将各腿的(θ_i1,θ_i2,θ_i3)参数代入公式(2)得到单腿运动学方程和腿末端位置。

进一步地，所述将机器人各部件的重力转移到中间腰部的几何中心，将重力集中处理，获得作用于腰部的六维力F，具体步骤包括：

利用质心公式，获得在躯干世界坐标系O_bw中任意吸附姿态下机器人的质心位置

在躯干世界坐标系O_bw中，根据力的平移定理将力转移到腰部，可得等效作用于腰部的六维力：

式中，F为重力集中后的等效六维力，m_c为机器人总质量，

为躯干世界坐标系O_bw下的质心的位置，a_g/|a_g|为重力加速度在躯干世界坐标系下的单位向量。

进一步地，所述根据所述机器人的吸附姿态和所述等效六维力F，建立机器人整体力平衡方程,具体步骤包括：

根据机器人机构，对机器人受力分析和相应简化,可得到静力学平衡方程:

f₁$₁+f₂$₂+f₃$₃+f₄$₄＝F

式中，f_i为第i腿的支链末端受到的壁面的反作用力，$_i为第i腿的支链末端受到的壁面的反作用力的单位线矢,F为重力集中后的等效六维力。

进一步地，所述将腿的结构导入有限元分析软件，并利用有限元分析得到腿子装配体静柔度模型，具体步骤包括：

根据装配和运动关系将每个腿视为2个子装配体的组合，定义为第一子装配体(1)和第二子装配体(2)，并利用有限元软件分析得到第一子装配体(1)在坐标系O₃的原点C_i处的静柔度矩阵K_C和第二子装配体(2)在腿末端A_i处的静柔度矩阵K_A；

分别建立第i腿的第一子装配体(1)在C_i处的静柔度模型和第i腿的第二子装配体(2)在A_i处的静柔度模型：

其中，

式中，

分别表示在坐标系O₂下作用在C_i处的六维力和在坐标系O₃下作用在A_i处的六维力，

分别表示在坐标系O₂下作用在C_i处的力和在坐标系O₃下作用在A_i处的力，

表示在坐标系O₂下作用在C_i处的力矩和在坐标系O₃下作用在A_i处的力矩，

为在坐标系O₃下第二子装配体在腿末端A_i处的线变形，

为在坐标系O₂下第一子装配体在C_i处的线变形。

进一步地，所述基于子装配体的静柔度模型，由线性组合得到各腿的静柔度模型和线变形，具体步骤包括：

在第一子装配体和第二子装配的线变形的基础上，利用坐标变化获得静柔度模型和各腿的线变形:

式中，

为第i腿的腿末端A_i在躯干世界坐标系O_bw下的线变形。

进一步地，提出各腿线变形协调条件以增加额外的约束方程，并根据所述的机器人整体力平衡方程和约束方程求解得到足端力，具体步骤包括：

腰部D₁D₂D₃D₄刚度较大，可认为在空间中长度和形状不变，存在如下的变形协调关系：

其中，

式中，

表示在躯干世界坐标系O_bw下的位置

指向位置点

的向量，

几何意义是向量

的模长；

分别表示因重力和足端反力变形前第i腿、第j腿的2号关节处在躯干世界坐标系O_bw下的位置，

分别表示因重力和足端反力变形后第i腿、第j腿的2号关节处在躯干世界坐标系O_bw下的位置，

分别表示因重力和足端反力变形前第i腿、第j腿的2号关节，

分别表示因重力和足端反力变形后第i腿、第j腿的2号关节；

联立机器人整体力平衡方程和约束方程，计算求解任意姿态吸附时机器人的四足足端力f_i。

进一步地，所述基于所述足端力进行力学分析，获得机器人的关节扭矩，具体包括：

分别对腿的1号、2号、3号关节取矩，

式中，τ_i1、τ_i2、τ_i3分别表示第i腿的1、2、3关节所受到的扭矩，

为在坐标系O₂下从D_i点指向H_i2点的向量，

为在坐标系O₂下从D_i点指向H_i3点的向量，

为在坐标系O₂下从D_i点指向A_i点的向量，

为

的逆矩阵。

本发明与现有技术相比，至少具有以下有益效果：

本发明考虑机器人的不同吸附姿态，采用吸附姿态描述机器人吸附的姿态信息，根据各腿线变形协调条件和机器人整体力平衡方程获得机器人各腿部的足端力，基于足端力获得机器人的关节扭矩。只需要一次仿真，后续只需通过改变输入参数即可获得机器人在不同吸附姿态下的足端力和关节扭矩，求解较为方便和准确，求解得到的关节扭矩可用于关节电机的选型和校核，可加快机器人的研发进程。

附图说明

图1是本发明实施例提供的一种不同姿态四足爬壁机器人的关节扭矩确定方法的流程图。

图2是本发明实施例中机器人的机械结构简图。

图3是本发明实施例中三个关节的关系示意图。

图4是本发明实施例中单腿的质心及示意坐标图。

图5是本发明实施例中机器人整体受力分析示意图。

图6是本发明实施例中单腿支链受力分析示意图。

图7是本发明实施例中多种姿态下求解得到的足端力曲线图。

图8是本发明实施例中关节扭矩曲线图。

具体实施方式

为了便于理解，下面结合附图和实施例对本发明作进一步说明。

本实施例提供的一种不同姿态四足爬壁机器人的关节扭矩确定方法，包括以下步骤：

步骤1：在机器人多腿吸附时，采用吸附姿态描述机器人吸附的状态信息，所述吸附姿态包括机器人的关节角度、中间腰部姿态和各腿是否吸附的状态。

具体的，本步骤包括：

步骤1.1：将机器人结构视为一个中间腰部D₁D₂D₃D₄和四条腿A_iB_iC_iD_iF_i(i＝1,2,3,4)构成，其中F_i、D_i、C_i分别为机器人第i腿的第1、2、3关节，并以中间腰部的中心为原点建立躯干世界坐标系O_bw；

步骤1.2：机器人的关节角度、中间腰部姿态和各腿是否吸附的状态存在如下关系：

Q＝(Q₁,Q₂…,Q_i,Q_t) (1)

其中，Q_i＝(θ_i1,θ_i2,θ_i3,s_i)^T

Q_t＝(a_g,1)^T

式中，Q表示机器人吸附姿态，Q_i表示第i腿的状态，Q_t表示机器人腰部姿态，i的范围为1-4，(θ_i1,θ_i2,θ_i3)表示第i腿的关节1、2、3处的关节角，s_i代表腿末端吸附状态，a_g表示重力加速度，上标T表示转置的意思。

图3为机器人各腿(θ_i1,θ_i2,θ_i3)参数的确定方法。X_i1、X_i2、X_i3表示第i条腿的坐标系O_k(k＝1,2,3)的X轴，(θ_i1,θ_i2,θ_i3)参数的确定方法是：以θ_i1(或θ_i2或θ_i3)的基准线为始边，X_i1(或X_i2或X_i3)为终边，始边旋转到终边的夹角即为θ_i1(或θ_i2或θ_i3)。

步骤2：通过运动学建模确定其腿末端位置和吸附姿态。

具体的，本步骤包括：

步骤2.1：进行D-H建模，按照相邻关节转动轴的交点(或者与公垂线的交点)为坐标系原点、转动轴方向为坐标系Z轴、Z_i与Z_i-1的公垂线或者外积方向为X_i-1和右手螺旋的规则确定了基于各关节轴和腿部末端坐标系O₁、O₂、O₃、O₄，机器人的每个腿部有3个关节，其中靠近机器人躯干的两个关节的关节轴相互垂直，定义为关节1、关节2，另一关节位于该两个关节和腿部末端之间，定义为关节3，关节3的关节轴与关节2的关节轴平行；

获得机器人单腿运动学方程：

式中，⁴P是点P在坐标系O₄中的坐标，^bwP表示点P在躯干世界坐标系下，

表示由坐标系On变换到坐标系O_n-1(n＝1,2,3,4)的变换矩阵。

步骤2.2：机器人其余三腿的位置可视为第2腿绕腰部中心旋转不同角度得到，无需重复进行D-H建模，将各腿的(θ_i1,θ_i2,θ_i3)参数带入步骤1.2中的式(1)即可确定机器人吸附姿态，将各腿的(θ_i1,θ_i2,θ_i3)参数带入式(2)计算可得到运动学方程和腿末端位置。

步骤3：利用力的平移原理将机器人各部件的重力转移到中间腰部的几何中心，将重力集中处理，获得作用于腰部的六维力F。

具体的，本步骤包括：

步骤3.1：如图4所示，连接关节1和关节2的连杆D_iF_i的质量和质心为m₁和H_i1，连接关节2和关节3的连杆C_iD_i的质量和质心为m₂和H_i2，连接关节3和腿部末端的连杆A_iB_iC_i的质量和质心为m₃和H_i3，在机机器人姿态变化时，机器人质心H_c的位置会发生变动，可利用质心公式，获得在躯干世界坐标系O_bw中任意吸附姿态下机器人的总质量m_c和质心位置

步骤3.2：在躯干世界坐标系O_bw中，由力的平移定理将力转移到中间腰部，可得等效作用于中间腰部的六维力F：

式中，m_c为机器人总质量，

为躯干世界坐标系O_bw下的质心的位置，a_g/|a_g|为重力加速度在躯干世界坐标系下的单位向量。

步骤4：根据所述机器人的吸附姿态和所述等效六维力F，建立机器人整体力平衡方程。

具体的，本步骤包括：

根据机器人机构，对机器人受力分析和相应简化，如图5所示，机器人4腿吸附在壁面上，将腰部重力和各腿支链的重力转化到坐标系O_bw原点得到主矢F_c和主矩M，机器人脚掌产生的吸附力F_P与壁面产生的反力F_N相抵消，并且腿部末端球铰不受力矩约束，可认为足端A_i仅受三维力f_i$_i，可得到静力学平衡方程，

f₁$₁+f₂$₂+f₃$₃+f₄$₄＝F (4)

式中f_i为第i腿支链末端受到的壁面的反作用力，$_i为第i腿支链末端受到的壁面的反作用力的单位线矢,F为重力集中后的等效六维力。

步骤5：将腿的结构导入有限元分析软件，并利用有限元分析得到腿子装配体静柔度模型。

具体的，本步骤包括：

根据装配和运动关系将腿视为2个子装配体的组合，如图6所示，，f_i为足端反力，

分别表示在坐标系O₂下作用在C_i处的六维力和在坐标系O₃下作用在A_i处的六维力，在机器人运动时，杆件1-1、1-2、1-3的位置相对固定，杆件2-1、2-2的位置相对固定，因而将杆件1-1、1-2、1-3组成的部件定义为第一子装配体1，将杆件2-1、2-2组成的部件定义为第二子装配体2；

并利用有限元软件分析，将机器人的腿三维模型导入有限元仿真软件，对腿施加相应的约束和外力(矩)，得到第一子装配体1在坐标系O₃的原点C_i处的静柔度矩阵K_C和第二子装配体2在腿末端A_i处的静柔度矩阵K_A；

分别建立第i腿的子装配体1在C₂处的静柔度模型和第i腿的装配体2在A_i处的静柔度模型，如图6所示，

分别表示在坐标系O₂下作用在C_i处的六维力和在坐标系O₃下作用在A_i处的六维力，可得如下关系式：

其中，

式中，

分别表示在坐标系O₂下作用在C_i处的力和在坐标系O₃下作用在位置A_i的力，

表示在坐标系O₂下作用在C_i处的力矩和在坐标系O₃下作用在A_i处的力矩，

为在坐标系O₃下子装配体2在腿末端A_i处的线变形，

分别为在坐标系O₂下子装配体1在C_i处的线变形。

步骤6：基于腿子装配体的静柔度模型，由线性组合得到腿的静柔度模型和线变形。

具体的，在子装配体1和子装配2的线变形的基础上，利用线性组合获得各腿的静柔度模型和线变形:

式中，

为各腿末端A₂在世界坐标系O_bw下的线变形。

分别为坐标系O₂和坐标系O₃旋转变换到世界坐标系O_bw的旋转变换矩阵。

步骤6：提出四腿变形协调条件以增加额外的约束方程，根据所述的机器人整体力平衡方程和约束方程求解得到足端力：

具体的，本步骤包括：

腰部D₁D₂D₃D₄刚度较大，可认为在空间中长度和形状不变，存在如下的变形协调关系：：

其中，

式中，

表示在躯干世界坐标系O_bw下的位置

指向位置点

的向量，

几何意义是向量

的模长；

表示因重力和足端反力变形前第i(j)腿的2号关节处在躯干世界坐标系O_bw下的位置，

表示因重力和足端反力变形后第i(j)腿的2号关节处在躯干世界坐标系O_bw下的位置，

表示因重力和足端反力变形前第i(j)腿的2号关节，

表示因重力和足端反力变形后第i(j)腿的2号关节；

联立机器人整体力平衡方程和约束方程，计算求解任意姿态吸附时机器人的四足足端力f_i。

步骤7：基于足端力进行力学分析，获得机器人的关节扭矩。

具体的，本步骤中：

分别对腿的1号、2号、3号关节取矩，

式中，τ_i1、τ_i2、τ_i3分别表示第i腿的1、2、3关节所受到的扭矩，

为在坐标系O₂下从D_i点指向H_i2点的向量(全文中出现的形如ⁱP_AB的意义以此类推)，

为

的逆矩阵。

通过所获得的足端力和关节扭矩，可方便进行于机器人关节电机选型，具体步骤包括：

模拟机器人实际运动和步态，确定多个机器人吸附姿态；

利用所述方法求解四足的足端力，得到四足的足端力曲线，如图7所示；

基于足端力计算得到不同吸附姿态下机器人各腿关节处的扭矩，机器人4条腿1、2、3号关节的最大扭矩值τ₁、τ₂、τ₃如图8所示；

由关节扭矩图可知关节扭矩最大值为120n·mm，可确定该四足爬壁机器人的关节电机的额定扭矩必须大于120n·mm，考虑到电机使用寿命，关节电机的额定扭矩必须大于360n·mm，根据该数据即可选定可适用的电机，如4.5kg电机。

作为优选的技术方案，验证关节电机选型的合理性，具体步骤包括：

对机器人样机进行周向爬壁实验，让机器人沿着圆柱管道内壁周向爬行，依次经过下底面、右侧面、上顶面、左侧面；

在关节电机的驱动下，机器人样机能够克服重力变化在管道壁面周向爬行，实验结果验证了通过本实施例提供的确定方法得到的足端力和关节扭矩的正确性以及机器人关节电机选型和校核的合理性，说明本发明方法实用可行。

显然，本发明的上述实施例仅仅是为清楚地说明本发明所作的举例，而并非是对本发明的实施方式的限定。对于所属领域的普通技术人员来说，在上述说明的基础上还可以做出其它不同形式的变化或变动。这里无需也无法对所有的实施方式予以穷举。凡在本发明的精神和原则之内所作的任何修改、等同替换和改进等，均应包含在本发明权利要求的保护范围之内。

Claims (9)

1.一种不同姿态四足爬壁机器人的关节扭矩确定方法，其特征在于，包括以下步骤：

在机器人多腿吸附时，采用吸附姿态描述机器人吸附的姿态信息，所述吸附姿态Q包括机器人的关节角度(θ_i1,θ_i2,θ_i3)、腰部姿态Q_t和各腿是否吸附的状态s_i，并确定所述机器人的关节角度、所述腰部姿态和所述各腿是否吸附的状态之间的关系；

通过运动学建模确定机器人吸附姿态和各腿的腿末端位置；

将机器人各部件的重力转移到腰部的几何中心，将重力集中处理，获得等效六维力F；

根据所述机器人的吸附姿态和所述等效六维力F，建立机器人整体力平衡方程；

将腿的结构导入有限元分析软件并利用有限元分析得到腿子装配体的静柔度模型；

基于子装配体的静柔度模型，由线性组合得到各腿的静柔度模型和线变形；

建立各腿线变形协调条件以增加额外的约束方程，并根据所述机器人整体力平衡方程和所述约束方程获得足端力；

基于所述足端力进行力学分析，获得机器人的关节扭矩。

2.根据权利要求1所述的一种不同姿态四足爬壁机器人的关节扭矩确定方法，其特征在于，所述采用吸附姿态描述机器人吸附的状态信息，具体包括：

将机器人结构视为包括一个中间腰部D₁D₂D₃D₄和四条腿A_iB_iC_iD_iF_i(i＝1,2,3,4)，其中F_i、D_i、C_i分别为机器人第i腿的3个关节，并以中间腰部的中心为原点建立躯干世界坐标系O_bw；

所述机器人的关节角度(θ_i1,θ_i2,θ_i3)、所述腰部姿态Q_t和各腿是否吸附的状态s_i存在如下关系：

Q＝(Q₁,Q₂…,Q_i,Q_t) (1)

其中，Q_i＝(θ_i1,θ_i2,θ_i3,s_i)^T，Q_t＝(a_g,1)^T

式中，Q表示机器人吸附姿态，Q_i表示第i腿的状态，Q_t表示机器人腰部姿态，，(θ_i1,θ_i2,θ_i3)表示第i腿的3个关节处的关节角，s_i代表腿末端吸附状态，a_g表示重力加速度，上标T表示转置。

3.根据权利要求1所述的一种不同姿态四足爬壁机器人的关节扭矩确定方法，其特征在于，所述通过运动学建模确定机器人吸附姿态和各腿的腿末端位置，具体步骤包括：

进行D-H建模，按照相邻关节转动轴的交点为坐标系原点、转动轴方向为坐标系Z轴、Z_i与Z_i-1的公垂线或者外积方向为X_i-1和右手螺旋的规则分别建立基于3个关节轴和腿部末端的坐标系O₁、O₂、O₃、O₄，

获得机器人单腿运动学方程：

式中，⁴P是点P在腿部末端坐标系O₄中的位置，^bwP表示点P在躯干世界坐标系O_bw下的位置，

表示由坐标系On变换到坐标系O_n-1的变换矩阵；

机器人其余三腿的位置可视为第2腿绕腰部中心旋转不同角度得到，基于所述机器人的关节角度、所述腰部姿态和所述各腿是否吸附的状态之间的关系，结合各腿的(θ_i1,θ_i2,θ_i3)参数，即可确定机器人吸附姿态；

将各腿的(θ_i1,θ_i2,θ_i3)参数代入公式(2)得到单腿运动学方程和腿末端位置。

4.根据权利要求1所述的一种不同姿态四足爬壁机器人的关节扭矩确定方法，其特征在于，所述将机器人各部件的重力转移到中间腰部的几何中心，将重力集中处理，获得作用于腰部的六维力F，具体步骤包括：

利用质心公式，获得在躯干世界坐标系O_bw中任意吸附姿态下机器人的质心位置

在躯干世界坐标系O_bw中，根据力的平移定理将力转移到腰部，可得等效作用于腰部的六维力：

式中，F为重力集中后的等效六维力，m_c为机器人总质量，

为躯干世界坐标系O_bw下的质心的位置，a_g/|a_g|为重力加速度在躯干世界坐标系下的单位向量。

5.根据权利要求1所述的一种不同姿态四足爬壁机器人的关节扭矩确定方法，其特征在于，所述根据所述机器人的吸附姿态和所述等效六维力F，建立机器人整体力平衡方程,具体步骤包括：

根据机器人机构，对机器人受力分析和相应简化,可得到静力学平衡方程:

f₁$₁+f₂$₂+f₃$₃+f₄$₄＝F

式中，f_i为第i腿的支链末端受到的壁面的反作用力，$_i为第i腿的支链末端受到的壁面的反作用力的单位线矢,F为重力集中后的等效六维力。

6.根据权利要求1所述的一种不同姿态四足爬壁机器人的关节扭矩确定方法，其特征在于，所述将腿的结构导入有限元分析软件，并利用有限元分析得到腿子装配体静柔度模型，具体步骤包括：

根据装配和运动关系将每个腿视为2个子装配体的组合，定义为第一子装配体(1)和第二子装配体(2)，并利用有限元软件分析得到第一子装配体(1)在坐标系O₃的原点C_i处的静柔度矩阵K_C和第二子装配体(2)在腿末端A_i处的静柔度矩阵K_A；

分别建立第i腿的第一子装配体(1)在C_i处的静柔度模型和第i腿的第二子装配体(2)在A_i处的静柔度模型：

其中，

式中，

分别表示在坐标系O₂下作用在C_i处的六维力和在坐标系O₃下作用在A_i处的六维力，

分别表示在坐标系O₂下作用在C_i处的力和在坐标系O₃下作用在A_i处的力，

表示在坐标系O₂下作用在C_i处的力矩和在坐标系O₃下作用在A_i处的力矩，

为在坐标系O₃下第二子装配体在腿末端A_i处的线变形，

为在坐标系O₂下第一子装配体在C_i处的线变形。

7.根据权利要求1所述的一种不同姿态四足爬壁机器人的关节扭矩确定方法，其特征在于，所述基于子装配体的静柔度模型，由线性组合得到各腿的静柔度模型和线变形，具体步骤包括：

在第一子装配体和第二子装配的线变形的基础上，利用坐标变化获得静柔度模型和各腿的线变形:

式中，

为第i腿的腿末端A_i在躯干世界坐标系O_bw下的线变形，

分别为坐标系O₂和坐标系O₃旋转变换到世界坐标系O_bw的旋转变换矩阵。

8.根据权利要求1所述的一种不同姿态四足爬壁机器人的关节扭矩确定方法，其特征在于，提出各腿线变形协调条件以增加额外的约束方程，并根据所述的机器人整体力平衡方程和约束方程求解得到足端力，具体步骤包括：

腰部D₁D₂D₃D₄刚度较大，可认为在空间中长度和形状不变，存在如下的变形协调关系：

其中，

式中，

表示在躯干世界坐标系O_bw下的位置

指向位置点

的向量，

几何意义是向量

的模长；

分别表示因重力和足端反力变形前第i腿、第j腿的2号关节处在躯干世界坐标系O_bw下的位置，

分别表示因重力和足端反力变形后第i腿、第j腿的2号关节处在躯干世界坐标系O_bw下的位置，

分别表示因重力和足端反力变形前第i腿、第j腿的2号关节，

分别表示因重力和足端反力变形后第i腿、第j腿的2号关节；

联立机器人整体力平衡方程和约束方程，计算求解任意姿态吸附时机器人的四足足端力f_i。

9.根据权利要求1-8任一所述的一种不同姿态四足爬壁机器人的关节扭矩确定方法，其特征在于，所述基于所述足端力进行力学分析，获得机器人的关节扭矩，具体包括：

分别对腿的1号、2号、3号关节取矩，

式中，τ_i1、τ_i2、τ_i3分别表示第i腿的1、2、3关节所受到的扭矩，

为在坐标系O₂下从D_i点指向H_i2点的向量，

为在坐标系O₂下从D_i点指向H_i3点的向量，

为在坐标系O₂下从D_i点指向A_i点的向量，

为

的逆矩阵。

Images