【技术实现步骤摘要】
本专利技术涉及机器人领域，具体地说是一种欠驱动灵巧手指的运动学解算方法。
技术介绍
1、手是人体中最灵活的运动结构，人类精细灵活的操作离不开手的参与，无论是具有不规则外形的复杂物体，还是细小轻微的物体，人类都能够通过多手指的协同运动实现对物体精准可靠的抓握和操作，因此机器人多指灵巧手也成为机器人领域的研究热点之一。
2、对于多指灵巧手的设计，若采用全驱动的方案——即执行器数目与手指自由度数目相等，虽然可以做到系统完全可控稳定，但会导致20个以上的主动自由度，系统的整体集成性太差，所需要的控制关节与执行器众多，尤其是针对驱动电机直接放置在手指关节的方案，手指往往多倍于正常人手指大小，不具有很好的拟人性，同时电机在手指关节处，导致手指缺乏抵抗外界冲击的柔性，外界一次较大的冲击往往意味着损坏一个关节电机，大量的执行器也导致全驱动的灵巧手指控制复杂，成本过高。因此目前对于灵巧手指的设计多采用欠驱动的方案，而在驱动方式上tendon driven(线驱动)给灵巧手这样一个狭小、精密空间的传动设计上带来了极大的灵活性，同时可以将执行器后移降低手指质量，减小手指惯性，并增加手指抵抗外界冲击的柔性。
3、但欠驱动手指由于其执行器数目少于自由度数目，运动学解算十分困难，运动控制也较为复杂，这些问题一直是制约灵巧手应用的瓶颈问题，其中如何对欠驱动手指进行运动学建模更是解决控制问题的前提，所以准确合适的运动学建模对于欠驱动手指的控制就显得尤为重要。目前对于灵巧手指的研究往往参照人类的手指特点，人类手指除拇指外，每个手指都具有四
技术实现思路
1、本专利技术的目的在于提供一种欠驱动灵巧手指的运动学解算方法，其利用虚拟连杆对欠驱动灵巧手指进行运动学建模，解决了手指非固联关节在转动时发生的滚动问题，从而能够定量描述驱动绳长和关节角之间的映射关系，实现了对手指实时且可视化的控制效果。
2、本专利技术的目的是通过以下技术方案来实现的：
3、一种欠驱动灵巧手指的运动学解算方法，包括如下步骤：
4、步骤一、利用旋转关节分别描述侧摆关节、掌指关节mcp、近端指间关节pip、远端指间关节dip运动状态，且任意一对旋转关节两圆心连线设为虚拟连杆；
5、步骤二、根据手指参数建立改进型d-h参数表，参数包括连杆长度ai-1、连杆扭角αi-1、连杆偏距di和关节角θi，其中关节角θ1～θ8与侧摆关节角θroll、掌指关节角θmcp、近端指间关节角θpip和远端指间关节角θdip对应关系为：
6、θ1+θ2＝θroll
7、θ3+θ4＝θmcp
8、θ5+θ6＝θpip
9、θ7+θ8＝θdip (2)；
10、通过变换矩阵获得手指指尖的位姿且所述指尖位姿矩阵为θroll、θmcp、θpip三个变量的函数；
11、步骤三、获得掌指关节角θmcp与对应驱动绳收缩量lmcp关系，进而获得对应电机控制的位置长度pmcp；
12、步骤四、获得侧摆关节角θroll与对应驱动绳收缩量的lroll关系，进而获得对应电机控制的位置长度proll；
13、步骤五、关节角θroll和关节角θmcp通过左、右驱动绳驱动，根据pmcp和proll获得左右两个直线电机的实际控制位置长度pleft和pright：
14、pleft＝pleft(0)-pmcp-proll
15、pright＝pright(0)-pmcp+proll (11)；
16、步骤六、获得近端指间关节角θpip与对应驱动绳收缩量的lpip关系，进而获得对应电机控制的位置长度ppip；
17、步骤七、关节角θpip通过中驱动绳驱动，根据ppip获得中间直线电机驱动的实际控制位置长度pcenter：
18、pcenter＝pcenter(0)-ppip (14)；
19、步骤八、确定手指期望关节角θmcp、θroll、θpip并输入系统，系统根据步骤一至步骤七解算获得指尖目标位姿矩阵以及各个直线电机的控制位置pleft、pright、pcenter用于控制手指运动。
20、步骤二中：用变换矩阵的乘积来表示：
21、
22、而关节角θ1～θ8与侧摆关节角θroll、掌指关节角θmcp、近端指间关节角θpip和远端指间关节角θdip对应关系为：
23、θ1+θ2＝θroll
24、θ3+θ4＝θmcp
25、θ5+θ6＝θpip
26、θ7+θ8＝θdip (2)；
27、上式(2)中；
28、
29、
30、
31、
32、上式(3)中，ri为对应旋转关节对应圆半径；
33、而θdip＝α*θpip (4)；
34、上式(4)中，比例系数α恒等于2/3；
35、将上式(2)～(4)代入变换矩阵式(1)，求得指尖位姿矩阵为θroll、θmcp、θpip三个变量的函数：
36、
37、上式(5)中：
38、
39、
40、
41、r12＝-s(θroll)，
42、r22＝c(θroll)，
43、r32＝0，
44、
45、
46、
47、
48、
49、
50、上组式(6)中s代表sin,c代表cos，ai由改进型d-h参数表获得。
51、步骤三中，掌指关节转动依靠左右两个直线电机同时收缩拉动左、右驱动绳驱动，所述左驱动绳和右驱动绳上均设有吊索与掌指指骨连接，吊索始终处于绷紧状态长度不变，受吊索约束，在转动的过程驱动绳与掌指指骨之间夹角θ保持不变，而掌指指骨上的线孔h位置和关节端旋转关节两圆圆心o3、o4相对位置固定，因此h与旋转关节两圆间切点距离不变，同时h和旋转关节两圆间切点连线，该连线与驱动绳之间的夹角α也保持不变，驱动绳收缩lmcp长度后，旋转关节两圆间切点视为沿o3圆弧移动lmcp长度，则有：
【技术保护点】
1.一种欠驱动灵巧手指的运动学解算方法，其特征在于：包括如下步骤：
2.根据权利要求1所述的欠驱动灵巧手指的运动学解算方法，其特征在于：
3.根据权利要求1所述的欠驱动灵巧手指的运动学解算方法，其特征在于：步骤三中，掌指关节转动依靠左右两个直线电机同时收缩拉动左、右驱动绳驱动，所述左驱动绳和右驱动绳上均设有吊索与掌指指骨连接，吊索始终处于绷紧状态长度不变，受吊索约束，在转动的过程驱动绳与掌指指骨之间夹角θ保持不变，而掌指指骨上的线孔H位置和关节端旋转关节两圆圆心O3、O4相对位置固定，因此H与旋转关节两圆间切点距离不变，同时H和旋转关节两圆间切点连线，该连线与驱动绳之间的夹角α也保持不变，驱动绳收缩lMCP长度后，旋转关节两圆间切点视为沿O3圆弧移动lMCP长度，则有：
4.根据权利要求3所述的欠驱动灵巧手指的运动学解算方法，其特征在于：步骤四中，左右两个直线电机驱动左、右驱动绳差动运动产生侧摆关节角θROLL，其中侧摆关节上的输入线孔与对应旋转关节两圆圆心O1O2连线之间的垂线长度为rR，交点为OR，以OR为圆心、rR为半径做虚拟圆，输入线孔
5.根据权利要求1所述的欠驱动灵巧手指的运动学解算方法，其特征在于：步骤六中，驱动绳末端绑在近端指间关节上形成绳结，关节端旋转关节两圆O5O6之间的初始切点为Op，关节初始位置到Op之间距离为rP，以Op为圆心、rP为半径做圆弧，在该圆弧上绳结所走的弧长等效为驱动绳收缩的长度lPIP，则有：
6.根据权利要求1所述的欠驱动灵巧手指的运动学解算方法，其特征在于：步骤八中，控制系统包括用于实时解算的上位机和控制各个直线电机的下位机，所述上位机设有屏幕，所述下位机设有控制器。
7.根据权利要求6所述的欠驱动灵巧手指的运动学解算方法，其特征在于：先在上位机输入期望的关节角θMCP、θROLL、θPIP，并根据步骤一至步骤七解算出三个直线电机的控制位置Pleft、Pright、Pcenter以及指尖目标位姿矩阵发送至下位机的控制器，控制器控制各个直线电机到达目标位置，同时控制器回传当前直线电机的状态到上位机，经上位机解算获得手指实时θMCP、θROLL、θPIP角度，进而获得实时的手指位姿在屏幕上展示。
8.根据权利要求7所述的欠驱动灵巧手指的运动学解算方法，其特征在于：控制器以固定时间间隔向直线电机发送目标位置，并通过PD反馈控制直线电机精准到达目标位置。
...【技术特征摘要】
1.一种欠驱动灵巧手指的运动学解算方法，其特征在于：包括如下步骤：
2.根据权利要求1所述的欠驱动灵巧手指的运动学解算方法，其特征在于：
3.根据权利要求1所述的欠驱动灵巧手指的运动学解算方法，其特征在于：步骤三中，掌指关节转动依靠左右两个直线电机同时收缩拉动左、右驱动绳驱动，所述左驱动绳和右驱动绳上均设有吊索与掌指指骨连接，吊索始终处于绷紧状态长度不变，受吊索约束，在转动的过程驱动绳与掌指指骨之间夹角θ保持不变，而掌指指骨上的线孔h位置和关节端旋转关节两圆圆心o3、o4相对位置固定，因此h与旋转关节两圆间切点距离不变，同时h和旋转关节两圆间切点连线，该连线与驱动绳之间的夹角α也保持不变，驱动绳收缩lmcp长度后，旋转关节两圆间切点视为沿o3圆弧移动lmcp长度，则有：
4.根据权利要求3所述的欠驱动灵巧手指的运动学解算方法，其特征在于：步骤四中，左右两个直线电机驱动左、右驱动绳差动运动产生侧摆关节角θroll，其中侧摆关节上的输入线孔与对应旋转关节两圆圆心o1o2连线之间的垂线长度为rr，交点为or，以or为圆心、rr为半径做虚拟圆，输入线孔在所述虚拟圆上的位置变化弧长近似等于驱动绳收缩长度，则有：
5.根据权利要求1...
【专利技术属性】
技术研发人员：赵忆文，刘倩倩，罗阳，姜运祥，赵新刚，张元林，李英立，
申请(专利权)人：中国科学院沈阳自动化研究所，
类型：发明
国别省市：
还没有人留言评论。发表了对其他浏览者有用的留言会获得科技券。