一种三自由度手腕及其运动学计算方法与流程

本发明涉及一种三自由度手腕及该三自由度手腕的运动学计算方法。

背景技术：

空间机器人在空间实验室或空间站的维护与日常工作中发挥着重要作用，在空间机器人的工作过程中，对其手腕部的运动自由度要求有三个，且对其运动精度及运动解耦性要求极高，因此，腕部对于机器手末端姿态的控制实现显得尤为重要。哈尔滨工业大学与大连理工大学联合研制了一种解耦型三自由度球型空间机器，其正、逆解的计算方法较为复杂，且在运用十字万向节的过程中，并未能真正考虑十字万向节本身的运动规律，以及内十字万向节对本结构的运动学计算产生的影响，造成计算上的不精确。

技术实现要素：

本发明的目的是：提高三自由度手腕末端位姿控制的准确性。

为了达到上述目的，本发明的技术方案是提供了一种三自由度手腕，其特征在于，包括固定在支架上的自转运动电机、上半球电机及下半球电机，其中：

自转运动电机通过外万向节齿轮传动机构将动力传递至回转轴承的内齿圈，回转轴承的外齿圈通过外万向节输入轴与外万向节相连，外万向节通过外万向节输出轴与输出支架相连，输出支架带动穿设在上半球旋转体中的输出轴，输出轴的一端露于上半球旋转体外；

上半球电机通过上半球齿轮传动机构将动力传递至输入轴，输入轴穿设在下半球旋转体中，输入轴的一端设于支架内，输入轴的该端部与支架之间设有轴承三，输入轴的另一端通过内万向节与输出轴的另一端相连，输入轴通过内万向节及输出轴带动上半球旋转体运动；

下半球电机通过下半球齿轮传动机构直接带动下半球旋转体运动。

优选地，所述外万向节齿轮传动机构包括设于所述自转运动电机的输出轴的外万向节一级齿轮及与外万向节一级齿轮相啮合的外万向节二级齿轮，外万向节二级齿轮通过传动轴连接外万向节三级齿轮，外万向节三级齿轮与回转轴承的内齿圈相啮合。

优选地，所述输出支架设于所述上半旋转球体外，输出支架与上半旋转球体之间设有滚动轴承。

优选地，所述上半球齿轮传动机构包括设于所述上半球电机的输出轴的上半球一级齿轮及与上半球一级齿轮相啮合的上半球二级齿轮，上半球二级齿轮与所述输入轴相固定。

优选地，所述下半球齿轮传动机构包括设于所述下半球电机的输出轴的下半球一级齿轮及与下半球一级齿轮相啮合的下半球二级齿轮，下半球二级齿轮固定在所述下半球旋转体上。

本发明的另一个技术方案是提供了一种上述的三自由度手腕的运动学计算方法，其特征在于，包括以下步骤：

步骤1、在所述支架的圆心处建立坐标系∑0；在所述下半球旋转体的下端面中心处建立坐标系∑1，坐标系∑1相对于坐标系∑0绕坐标系∑0的z轴旋转角度α；在所述下半球旋转体的上斜面中心处建立坐标系∑2，坐标系∑2相对于坐标系∑1绕坐标系∑1的x轴旋转角度β；在所述上半球旋转体的上斜面中心处建立坐标系∑3，坐标系∑3相对于坐标系∑2绕坐标系∑2的y轴旋转角度γ；在上半球旋转体的上端面中心处建立坐标系∑4，坐标系∑4与坐标系∑2各轴方向一致；在输出轴上端位置处建立坐标系∑5，坐标系∑5相对于坐标系∑4沿坐标系∑4的z轴正方向位移距离l1；

步骤2、根据坐标系∑0、坐标系∑1、坐标系∑2、坐标系∑3、坐标系∑4及坐标系∑5之间的关系，建立变换矩阵t；

步骤3、若已知所述自转运动电机、上半球电机及下半球电机的转速及运动时间，则计算得到所述下半球旋转体绕自身旋转角度θ1、所述上半球旋转体绕自身旋转角度θ3、所述外万向节绕自身旋转角度θ4，结合上述的三自由度手腕的结构几何关系得到所述上半球旋转体和所述下半球旋转体的相对旋转角度θ2，将θ1、θ2、θ3及θ4代入变换矩阵t得到上述的三自由度手腕的末端位姿；

若已知如权利要求1所述的三自由度手腕的末端位姿和运动时间，则通过末端位姿和如权利要求1所述的三自由度手腕的结构几何关系得到θ1、θ2、θ3及θ4，根据θ1、θ2、θ3及θ4以及运动时间换算得到所述自转运动电机、上半球电机及下半球电机的转速。

优选地，设m为所述θ1和所述θ3的差的绝对值，则在所述步骤3中，θ2的计算公式为：

若m＜π，

若m≥π，式中：

为面p1的方向向量，面p1为直线l1与直线l2构成的平面，直线l1为所述内万向节中心的一根始终水平的轴，直线l2为与直线l1始终垂直的轴；为面zoy的法向量，θ2为面zoy与面p1的面面夹角。

优选地，在所述步骤3中，通过所述θ4计算得到θ4′，由θ4′得到如权利要求1所述的三自由度手腕的末端位姿，其中：

式中：

为运动结束时刻面p3的法向量，面p3为所述输出轴上过输出轴的轴线，面p3与面p2垂直，面p2为过所述外万向节中心且与水平面垂直的一个面，θ′4为外十字万向节输入轴的自转角度；

为运动初始时刻面p3的法向量。

优选地，在所述步骤3中，设所述三自由度手腕的末端位姿的坐标为(x,y,z)，则有：

式中：

；e为由正解公式逆解求得的含有θ′4的多项式。

本发明相对于现有技术取得了以下效果：

在计算上下半球相对转角时，利用空间几何的方法，将线与线的夹角转化为空间中线与面的夹角，简化了计算过程与复杂度。在算法的设计中考虑了十字万向节的运动规律：输出轴与输出轴相对的位姿(除去自转)需用两个角度来限制即俯仰与侧摆角。在考虑这样的位姿限制后，得出的末端姿态才与实际的运动规律相符，对实际的运用中有重要指导意义。本发明运动学正、逆解计算方法基于空间几何与旋转坐标变换矩阵，计算简单明了，结果精确。

附图说明

图1为本发明的流程图；

图2为本发明提供的三自由度手腕结构轴视图；

图3为本发明提供的三自由度手腕结构剖视图；

图4为本发明提供的三自由度手腕坐标系示意图；

图5为本发明提供的三自由度手腕运动学计算方法流程图；

图6为本发明提供的θ2求解几何示意图。

具体实施方式

下面结合具体实施例，进一步阐述本发明。应理解，这些实施例仅用于说明本发明而不用于限制本发明的范围。此外应理解，在阅读了本发明讲授的内容之后，本领域技术人员可以对本发明作各种改动或修改，这些等价形式同样落于本申请所附权利要求书所限定的范围。

如图1及图2所示，本发明提供的一种三自由度手腕，其特征在于，包括固定在支架4上的自转运动电机1、上半球电机2及下半球电机3，其中：

自转运动电机1的输出轴设有外万向节一级齿轮16，外万向节二级齿轮15与外万向节一级齿轮16相啮合，外万向节二级齿轮15通过传动轴14连接外万向节三级齿轮13，外万向节三级齿轮13与回转轴承的内齿圈12相啮合，回转轴承的外齿圈7通过外万向节输入轴28与外万向节9相连，外万向节9通过外万向节输出轴10与输出支架29相连，输出支架29带动穿设在上半球旋转体11中的输出轴19，输出轴19的一端露于上半球旋转体11外。输出支架29设于上半旋转球体11外，输出支架29与上半旋转球体11之间设有滚动轴承20。

上半球电机2的输出轴设有上半球一级齿轮5，上半球二级齿轮6与上半球一级齿轮5相啮合，上半球二级齿轮6与输入轴25相固定。输入轴25穿设在下半球旋转体8中，输入轴25的一端设于支架4内，输入轴25的该端部与支架4之间设有轴承三27，输入轴25的另一端通过内万向节21与输出轴19的另一端相连，输入轴25通过内万向节21及输出轴19带动上半球旋转体11运动。内万向节21外设有轴承套22，轴承套22外设有轴承一23。

下半球电机3的输出轴上设有下半球一级齿轮17，下半球二级齿轮18与下半球一级齿轮17相啮合，下半球二级齿轮18固定在下半球旋转体8上。输入轴25与下半球旋转体8之间设有轴承四26，下半球旋转体8与支架4之间设有轴承二24。

上述三自由度手腕结构可实现三自由度运动：俯仰、侧摆和自转，其中，俯仰和侧摆自由度的实现方式是通过两种运动组合而成。第一种运动是下半球电机3带动下半球一级齿轮17运动，下半球一级齿轮17通过啮合作用带动下半球二级齿轮18运动，下半球二级齿轮18固定在下半球旋转体8上，从而带动下半球旋转体8运动。第二种运动是上半球电机2带动上半球一级齿轮5运动，上半球一级齿轮5通过啮合作用带动上半球二级齿轮6运动，上半球二级齿轮6与输入轴25相固定，从而带动输入轴25运动，输入轴25通过内万向节21和输出轴19带动上半球旋转体11运动。自转自由度的而实现方式为：自转运动电机1通过外万向节一级齿轮16、外万向节二级齿轮15、外万向节三级齿轮13和内齿圈12将运动传至外万向节输入轴28，外万向节输入轴28通过外万向节9和外万向节输出轴10带动输出轴19实现自转自由度。

本发明还提供了一种上述三自由度手腕的运动学计算方法，包括以下步骤：

步骤1、在所述支架4的圆心处建立坐标系∑0，坐标系∑0的x轴x0、y轴y0方向位于支架4平面上，x轴z0方向垂直支架4平面向上，x0方向与外万向节输入轴28侧棱垂直，根据笛卡尔坐标系可以确定y0方向；

在所述下半球旋转体8的下端面中心处建立坐标系∑1，坐标系∑1相对于坐标系∑0绕坐标系∑0的z轴旋转角度α；

在所述下半球旋转体8的上斜面中心处建立坐标系∑2，坐标系∑2相对于坐标系∑1绕坐标系∑1的x轴旋转角度β；

在所述上半球旋转体11的上斜面中心处建立坐标系∑3，坐标系∑3相对于坐标系∑2绕坐标系∑2的y轴旋转角度γ；

在上半球旋转体11的上端面中心处建立坐标系∑4，坐标系∑4与坐标系∑2各轴方向一致；

在输出轴19上端位置处建立坐标系∑5，坐标系∑5相对于坐标系∑4沿坐标系∑4的z轴正方向位移距离l1。

步骤2、根据坐标系∑0、坐标系∑1、坐标系∑2、坐标系∑3、坐标系∑4及坐标系∑5之间的关系，建立变换矩阵t，式中，以为例，表示坐标系∑0至坐标系∑1的变换矩阵，其他参数以此类推。

步骤3、若已知所述自转运动电机1、上半球电机2及下半球电机3的转速n及运动时间t，则可以根据运动学正解计算方法得到三自由度手腕的末端位姿：计算得到所述下半球旋转体8绕自身旋转角度θ1、所述上半球旋转体11绕自身旋转角度θ3、所述外万向节9绕自身旋转角度θ4，结合上述的三自由度手腕的结构几何关系得到所述上半球旋转体11和所述下半球旋转体8的相对旋转角度θ2，将θ1、θ2、θ3及θ4代入变换矩阵t得到如权利要求1所述的三自由度手腕的末端位姿。具体而言，在上述的三自由度手腕的结构中，当内万向节21随着上半球旋转体11旋转θ3时，直线l1在水平面旋转θ3。直线l1为内万向节21中心的一根始终水平的轴，其初始位置与坐标系∑5的x轴重合。与直线l1垂直的另一轴，即直线l2，则是以偏置斜面的中心轴为旋转轴，4倍的偏置角为圆锥角旋转。直线l2与直线l1的初始位置在同一水平面内。整个旋转过程中，直线l1与直线l2始终保持垂直，一根轴始终在水平面内旋转，另一轴则形成圆锥面。直线l3为圆锥面的中心线，面p1为直线l1与直线l2构成的平面，所求θ2为面zoy与面p1的面面夹角，设m为所述θ1和所述θ3的差的绝对值，则有：

若m＜π，

若m≥π，式中：

为面p1的方向向量，为面zoy的法向量。

根据正运动学可得到三自由度俯仰和侧摆末端位姿：x、y和z。

通过θ4和结构几何关系可以得到θ4′，而得到三自由度手腕自转后末端位姿：式中：

为运动结束时刻面p3的法向量，面p3为所述输出轴19上过输出轴19的轴线，面p3与面p2垂直，面p2为过所述外万向节9中心且与水平面垂直的一个面，初始时刻，面p2与坐标系∑5的x轴垂直；为运动初始时刻面p3的法向量。

若已知上述的三自由度手腕的末端位姿和运动时间，则通过末端位姿和如权利要求1所述的三自由度手腕的结构几何关系得到θ1、θ2、θ3及θ4，根据θ1、θ2、θ3及θ4以及运动时间t换算得到所述自转运动电机1、上半球电机2及下半球电机3的转速n。

所述三自由度手腕的末端位姿的坐标为(x,y,z)，则可以直接求得θ2：

由正解旋转变换矩阵和末端坐标联立等式求得的关于θ1的等式：

由正解公式逆解求得：

式中：e为由正解公式逆解求得的含有θ′4的多项式。

将求得θ2带入到上述变换矩阵中可得到θ1、θ3。