1.一种考虑关节摩擦的并联机器人的动力学建模方法,其特征在于,所述方法包括:步骤1,获取二自由度冗余并联机器人的平面结构,将二自由度冗余并联机器人分为三个开式支链子系统,利用拉格朗日方程建立每个开式支链子系统的动力学解析模型;其中,每个开式支链子系统为包含主动关节和被动关节的二杆机构,且主动关节与基座断开连接;
步骤1具体包括如下子步骤:
(1a)确定每个开式支链子系统的拉格朗日函数值Li=Eai+Ebi;
其中,Eai表示第i个子系统中主动杆的动能,Ebi表示第i个子系统中被动杆的动能;
(1b)根据拉格朗日‑欧拉动力学方程: 得到每个开式支链子系统的动力学解析模型
其中,Mi(qi,t)表示第i个子系统的质量惯性矩阵, 表示第i个子系统的科式T
力矩阵,τi(t)表示第i个子系统的关节力矩τi(t)=[τai τbi] ,qi表示第i个子系统的转动角T
度,qi=[qai qbi] ,qai表示第i个子系统中的主动关节的转动角度;qbi表示第i个子系统中的被动关节的转动角度; 表示第i个子系统的转动角速度, 表示第i个子系统中的主动关节的转动角速度, 表示第i个子系统中的被动关节的转动角速度;
表示第i个子系统的转动角加速度, 表示第i个子系统中的主动关节的转动角加速度, 表示第i个子系统中的被动关节的转动角加速度;
步骤2,获取二自由度冗余并联机器人末端执行器的约束关系,根据所述约束关系建立与基座断开连接的二自由度冗余并联机器人的动力学模型;
步骤2具体包括如下子步骤:
(2a)获取二自由度冗余并联机器人末端执行器的约束关系:得到具有二阶矩形式的约束方程:其中,(xa1,ya1)表示第一个主动关节处的坐标,(xa2,ya2)表示第二个主动关节处的坐标,(xa3,ya3)表示第三个主动关节处的坐标;l表示主动杆或被动杆的长度,q=[qa1 qb1 qa2 T
qb2 qa3 qb3],
(2b)与基座断开连接的二自由度冗余并联机器人的动力学模型为:‑1/2
其中,B1(q,t)=A1(q,t)M (q,t),上标+表示Moor‑Penrose广义逆, 表示由二自由度冗余并联机器人末端执行器的约束关系所引起的约束力, 表示包括关节
1/2 ‑1
力矩、科式力矩阵的参数矩阵,M (q,t)表示质量矩阵的1/2次方,M (q,t)表示质量矩阵的逆矩阵,A1(q,t)表示第一层约束下具有二阶形式的约束方程系数矩阵,A2(q,t)表示第二层‑1/2
约束下具有二阶形式的约束方程系数矩阵,M (q,t)表示质量矩阵的‑1/2次方;
6×6
M(q,t)∈R 为并联机器人的质量矩阵, 为并联机器人的科氏力矩阵,
6 6
q∈R为并联机器人的关节角向量,τ(t)∈R为并联机器人的关节力矩,其定义分别为步骤3,获取每个开式支链子系统中主动关节与基座之间的运动约束关系,根据所述主动关节与基座之间的运动约束关系建立二自由度冗余并联机器人的整体动力学模型;
步骤3具体包括如下子步骤:
(3a)获取每个子系统中主动关节与基座之间的运动约束关系:得到所述运动约束关系的二阶形式:其中,(A1x,A1y)表示第一个主动关节处的坐标,(A2x,A2y)表示第二个主动关节处的坐标,(A3x,A3y)表示第三个主动关节处的坐标;
(3b)根据每个主动关节与基座之间的运动约束关系建立二自由度冗余并联机器人的整体动力学模型:
‑1/2
其中,B2(q,t)=A2(q,t)M (q,t), 表示由每个子系统中主动关节与基座之间的运动约束关系所引起的约束力;
步骤4,基于摩擦力经典模型建立二自由度冗余并联机器人在每个主动关节处的摩擦力模型;根据二自由度冗余并联机器人的整体动力学模型以及二自由度冗余并联机器人在每个主动关节处的摩擦力模型,得到考虑主动关节摩擦的并联机器人的动力学模型,其中,摩擦力经典模型为库伦摩擦力模型或者Stribeck摩擦力模型。
2.根据权利要求1所述的一种考虑关节摩擦的并联机器人的动力学建模方法,其特征在于,步骤4中,当所述摩擦力经典模型为库伦摩擦力模型时,步骤4具体包括如下子步骤:(4a1)获取库伦摩擦力矩模型:(4a2)根据库伦摩擦力矩模型确定主动关节处的库伦摩擦力矩解耦模型为:
6×6
其中,Fc表示由约束力产生的库伦摩擦力,R表示轴颈半径,I∈R 为单位矩阵,A(q,t)=A2(q,t);
(4a3)根据主动关节处的库伦摩擦力矩解耦模型以及二自由度冗余并联机器人的整体动力学模型,得到考虑主动关节库伦摩擦的并联机器人的动力学模型:
3.根据权利要求1所述的一种考虑关节摩擦的并联机器人的动力学建模方法,其特征在于,步骤4中,当所述摩擦力经典模型为Stribeck摩擦力模型时,步骤4具体为:(4b1)获取Stribeck摩擦力矩模型: 其中, 为主动关节的角, 主动关节处的Stribeck速度,Tc为库伦摩擦力矩,Ts为静摩擦力矩;
(4b2)根据Stribeck摩擦力矩模型确定主动关节处的Stribeck摩擦力矩解耦模型为:(4b3)根据主动关节处的Stribeck摩擦力矩解耦模型以及二自由度冗余并联机器人的整体动力学模型,得到考虑主动关节Stribeck摩擦的并联机器人的动力学模型: