完全重力平衡的6自由度串联式主手机器人制造技术

一种完全重力平衡的6自由度串联式主手机器人：分别固定在基座上的第一关节驱动电机和第一关节轴；第一关节丝盘，通过回转副可旋转的连接在第一关节轴的下端，所述的第一关节驱动电机的输出轴通过传动丝连接第一关节丝盘；两个吊架，分别固定连接在第一关节丝盘底部端面上的两侧；大臂关节轴，该大臂关节轴的两端部分别对称的固定在所述的两个吊架下端部；第二、三关节丝盘，该第二、三关节丝盘的回转中心固定连接在大臂关节轴上；平行四边形驱动机构，该平行四边形驱动机构可旋转的连接在大臂关节轴上，且底部连接腕部机构。本发明专利技术能够实现6自由度力感机器人的完全重力平衡，满足力雅克比方程成立条件，使主手机器人具有良好的静态透明性，提高力感精度。

【技术实现步骤摘要】

本专利技术涉及一种6自由度串联式主手机器人。特别是涉及一种能够完全重力平衡的6自由度串联式主手机器人。
技术介绍
(I)目前国际上已经推出的商品化力感机器人,如美国SensAble Technologies的PHANTOM系列力感机器人和法国Haption公司的Virtuose系列力感机器人等均没有实现完全重力平衡，仅是进行了位置机构的重力平衡设计。如果主手机器人没有完全重力平衡，就不满足力雅克比计算前提条件，所计算出的关节力矩值会存在一定的误差，进而影响到主手机器人的力感精度。(2)在专利号为CN102320040A的专利技术专利中，其自主调节平衡机构采用一个直流电机通过减速装置驱动和控制一个平衡滑块自动地对手臂机构进行自重补偿。考虑到腕部要作3维运动，因此这种补偿方法的应用受到不小的限制，除非腕部质心始终位于机器人手臂上某一定点。在专利号为CN102152299A的专利技术专利中，为腕关节机构各姿态架提供动力的电机置于小臂及姿态架内部。考虑到电机的质量不容忽视，因此该专利技术机构存在不小的动态惯性力，会对力感精度与力感方向造成不小的影响。在专利号为CN101623864A的专利技术专利中，其位置机构实现了重力平衡，但对姿态机构没有进行重力平衡设计。在专利号为CN101480798A的专利技术专利中，公开了一种力反馈手控器的高精度、低惯性直线位移机构，能够实现单自由度的力觉反馈。在专利号为CN101439514A的专利技术专利中，公开了一种滑块式结构解耦六维力反馈装置，可做到六自由度无条件解耦，结构简单，容易控制，运动精度高。但由于没有进行重力平衡设计，因此除非采用其他的办法进行重力补偿，否则难以实现主动力感。在专利号为CN101439515A的专利技术专利中，公开了一种平行四杆式结构解耦六维力反馈装置，由固定基座、三自由度并联移动单元、三自由度并串联转动单元构成。该专利也没有进行重力平衡设计，因此除非能够采用其他的办法实现重力补偿，否则也难以实现主动力感。在专利号为CN101444431A的专利技术专利中，公开了一种用于辅助微创外科手术机器人的三维力反馈主操作手。没有提及重力平衡问题。在专利号为CN201224104Y的专利技术专利中，公开了一种力反馈三自由度手控器的机构，由菱形连杆机构组件、手部机构、配重、支架、手柄连接件和配重连接件组成。实现了重力平衡，但专利技术机构仅具有3个自由度。在专利号为CN101261781A的专利技术专利中，公开了一种五自由度力反馈虚拟手术器械，其允许的人体运动关节包括手臂的腕关节、肘关节和肩关节。没有提及重力平衡问题。从其附图可以判定，该专利没有进行重力平衡设计。专利号为CN2772746Y的专利技术专利，涉及一种实现遥控操作机器人控制的人机接口装置，由数据手套和力反馈装置组成，在数据手套的手指和手掌上分别连接有连接扣，力反馈装置由缸体和活塞组成，在缸体的活塞运动空间内充有电流变液体。在工作原理上与本次新申请的专利完全不同。在专利号为CN1593861A的专利技术专利中，公开了一种可穿戴式的柔性外骨骼机械手，由肩部大3RPS并联机构、肩部滑环机构、两个肘部四杆机构、腕部滑环机构和腕部小3RPS并联机构依次串连而成，具有9个自由度，可满足人体上臂全方位运动的要求。该机械手采用气缸作为执行元件。在工作原理上与本次新新申请的专利完全不同。专利号为CN1488474A的专利技术专利也是一种面向人机交互的带有力反馈的外骨架式可佩戴数据臂。在工作原理上与本次新申请的专利完全不同。在专利号为CN1410232A的专利技术专利中，公开了一种6自由度通用型异构式机器人手控器(图1)，它由手部转动机构、支架和配重组成，支架上设双平行连杆机构，由3 4根 联杆构成，联杆上有三个万向节。双平行连杆机构进行了重力平衡。在机器人构型等方面与与本次新申请的专利完全不同。
技术实现思路
本专利技术所要解决的技术问题是，提供一种能够解决力感主手完全重力平衡问题的完全重力平衡的6自由度串联式主手机器人。本专利技术所采用的技术方案是一种完全重力平衡的6自由度串联式主手机器人，包括分别固定在基座上的第一关节驱动电机和第一关节轴；第一关节丝盘，通过回转副可旋转的连接在第一关节轴的下端，所述的第一关节驱动电机的输出轴通过传动丝连接第一关节丝盘；两个吊架，分别固定连接在第一关节丝盘底部端面上的两侧；大臂关节轴，该大臂关节轴的两端部分别对称的固定在所述的两个吊架下端部；第二、三关节丝盘，该第二、三关节丝盘的回转中心固定连接在大臂关节轴上；平行四边形驱动机构，该平行四边形驱动机构可旋转的连接在大臂关节轴上，且底部连接腕部机构。所述的第一关节驱动电机和第一关节轴通过支架相连。所述的第一关节轴的轴线铅垂设置。所述的平行四边形驱动机构包括有大臂，可旋转的连接在所述的大臂关节轴上，所述的大臂的上端分别固定有大臂配重和第二关节驱动电机，所述的第二关节驱动电机的输出轴通过传动丝连接所述的第二、三关节丝盘；曲柄，可旋转的连接在大臂关节轴上，所述的曲柄的一端分别固定有小臂配重和第三关节驱动电机，所述曲柄的另一端连接连杆的上端；小臂，该小臂的一端通过第三关节连接在所述大臂的底端，该小臂的臂部铰接在所述的连杆的底端，该小臂的另一端通过第四关节连接腕部机构。所述的腕部机构包括有连接在第四关节上的L型支架，固定在L型支架一端的第五关节配重，分别固定在L型支架另一端的第五关节和第六关节。所述的第四关节的轴线、第五关节的轴线和第六关节的轴线三者汇交于一点。所述的第四关节、第五关节和第六关节分别连接有绝对式码盘。第一关节驱动电机、第二关节驱动电机和第三关节驱动电机均采用直流电机，并各连接一个光电码盘。本专利技术的完全重力平衡的6自由度串联式主手机器人，能够实现6自由度力感机器人的完全重力平衡，满足力雅克比方程成立条件，使主手机器人具有良好的静态透明性，提闻力感精度。附图说明图I是本专利技术的整体结构示意图。 图中I:第一关节驱动电机2:第一关节轴3 :支架4 :第一关节丝盘5:吊架6 :大臂关节轴7:第二、三关节丝盘8:大臂9:大臂配重10:第二关节驱动电机11:曲柄12 :小臂配重13:第三关节驱动电机14:连杆15 :小臂16 :第三关节17:第四关节18:L型支架19 :第五关节配重20 :第五关节21 :第六关节具体实施例方式下面结合实施例和附图对本专利技术的完全重力平衡的6自由度串联式主手机器人做出详细说明。本专利技术的完全重力平衡的6自由度串联式主手机器人，是采用下述的方法进行设计的(I)首先通过对称设计或配重的方法逆序依次实现腕部3个关节机构的重力平衡设计，让整个手腕的质心位于主手机器人小臂杆件上某一定点。在具体设计时，先设法使得第六关节轴的质心位于该定点，然后通过对称或配重方法让第五关节轴的质心也位于此定点位置，再通过对称或配重方法让第四关节轴的质心也处于该定点位置。在满足主手机器人刚度条件前提下，应尽量减少各个关节机构的自重。为了有效减轻整个腕部的质量，上述关节均采用绝对式编码器。(2)将小臂驱动电机通过平行四边形机构后移到大臂关节轴侧，进一步减小机器人的表观质量。小臂驱动电机输出轴通过钢丝与丝盘相联，并沿着丝盘外周滚动，再通过平行四边形机构带动小臂关节回转。其平衡重配置在四杆机构的曲柄上。(3)大本文档来自技高网...

【技术保护点】
一种完全重力平衡的6自由度串联式主手机器人，其特征在于，包括：分别固定在基座上的第一关节驱动电机（1）和第一关节轴（2）；第一关节丝盘（4），通过回转副可旋转的连接在第一关节轴（2）的下端，所述的第一关节驱动电机（1）的输出轴通过传动丝连接第一关节丝盘（4）；两个吊架（5），分别固定连接在第一关节丝盘（4）底部端面上的两侧；大臂关节轴（6），该大臂关节轴（6）的两端部分别对称的固定在所述的两个吊架（5）下端部；第二、三关节丝盘（7），该第二、三关节丝盘（7）的回转中心固定连接在大臂关节轴（6）上；平行四边形驱动机构，该平行四边形驱动机构可旋转的连接在大臂关节轴（6）上，且底部连接腕部机构。

【技术特征摘要】

【专利技术属性】
技术研发人员：赵臣，闫帅，赵汉望，范荣芳，马峰涛，
申请(专利权)人：天津大学，
类型：发明
国别省市：