[发明专利]一种机械臂与灵巧手的融合系统及运动控制方法

权利要求书

1.一种机械臂与灵巧手的融合系统，其特征在于：包括一条四自由度机械臂、一个灵巧手手腕和一个灵巧手，灵巧手手腕安装在四自由度机械臂的末端，灵巧手手掌安装在灵巧手手腕上；灵巧手手腕和四自由度机械臂通过电子线路连接。

2.根据权利要求1所述的一种机械臂与灵巧手的融合系统，其特征在于：灵巧手手腕是一个两自由度并联机构，包括两台电机、两根推杆和两台伺服位置控制器；

两台伺服位置控制器分别为主动伺服位置控制器和从动伺服位置控制器，两台电机包括第一电机和第二电机，两根推杆包括第一推杆和第二推杆，主动伺服位置控制器用于驱动第一电机运动，第一电机运动带动第一推杆运动，从动伺服位置控制器用于驱动第二电机运动，第二电机运动带动第二推杆运动；第一推杆的末端和第二推杆的末端同时与灵巧手手掌连接。

3.根据权利要求2所述的一种机械臂与灵巧手的融合系统，其特征在于：两台电机采用同步差动控制方式，两台电机驱动两根推杆运动，实现灵巧手的俯仰运动和偏航转动。

4.根据权利要求3所述的一种机械臂与灵巧手的融合系统，其特征在于：当两根推杆同向运动时灵巧手进行俯仰运动，俯仰角度范围为-70度—70度；当两根推杆反向运动运动时灵巧手进行偏航转动，偏航角度范围为-45度—45度。

5.一种机械臂与灵巧手的融合系统的运动控制方法，其特征在于包括：

将四自由度机械臂与灵巧手融合系统看作一个六轴串联机械臂，以四自由度机械臂基座中心为原点，使用D-H方法建立机械臂坐标系，并给出机械臂各关节及连杆的D-H参数；

根据四自由度机械臂的关节角度θ₁、θ₂、θ₃、θ₄和灵巧手手腕的关节角度θ₅、θ₆，通过四自由度机械臂与灵巧手手腕融合系统的正运动学方法，求得灵巧手手腕末端的位置姿态矩阵实现对融合系统正向运动控制；R表示灵巧手手腕末端的旋转矩阵，P表示灵巧手手腕末端的位置矩阵；

若已知灵巧手手腕末端位置姿态通过四自由度机械臂与灵巧手手腕融合系统的逆运动学数值求解方法，求得融合系统的关节角度θ₁、θ₂、θ₃、θ₄、θ₅、θ₆，根据关节角度获得控制指令，发送给伺服位置控制器，以驱动灵巧手手腕末端达到预定的位置姿态。

6.根据权利要求5所述的一种机械臂与灵巧手的融合系统的运动控制方法，其特征在于：对融合系统正向运动控制时，灵巧手手腕末端的位置姿态

⁰₁T为融合系统中，机械臂基坐标系到机械臂第一关节的坐标转换矩阵；

为融合系统中，机械臂第一关节到机械臂第二关节的坐标转换矩阵；

为融合系统中，机械臂第二关节到机械臂第三关节的坐标转换矩阵；

为融合系统中，机械臂第三关节到机械臂第四关节的坐标转换矩阵；

为融合系统中，机械臂第四关节到灵巧手手腕第一关节的坐标转换矩阵；

为融合系统中，灵巧手手腕第一关节到灵巧手手腕第二关节的坐标转换矩阵；

为融合系统中，机械臂基坐标系到灵巧手手腕末端的坐标转换矩阵。

7.根据权利要求6所述的一种机械臂与灵巧手的融合系统的运动控制方法，其特征在于：

其中，dj为第j个关节与第j-1个关节的连杆距离，j＝2，3，4，5；a_p为第p个关节的连杆长度，p＝2；

si为第i个关节角度正弦，ci为第i个关节角度余弦，i＝1，2，3，4，5，6。

8.根据权利要求7所述的一种机械臂与灵巧手的融合系统的运动控制方法，其特征在于：si＝sinθ_i，ci＝cosθ_i。