CN102825601B - 一种拟人式6自由度机器人重力平衡方法 - Google Patents
一种拟人式6自由度机器人重力平衡方法 Download PDFInfo
- Publication number
- CN102825601B CN102825601B CN201210339981.3A CN201210339981A CN102825601B CN 102825601 B CN102825601 B CN 102825601B CN 201210339981 A CN201210339981 A CN 201210339981A CN 102825601 B CN102825601 B CN 102825601B
- Authority
- CN
- China
- Prior art keywords
- gravitational equilibrium
- forearm
- wrist
- drive motors
- counterweight
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Active
Links
Landscapes
- Manipulator (AREA)
Abstract
一种拟人式6自由度机器人重力平衡方法:采用拟人式布置方式设置整个6自由度主手机器人,将6自由度主手机器人的第一个关节轴垂直布置,使第一个关节在重力作用下不会产生绕垂直轴线的回转运动;将手腕3个关节机构呈腕心布置,通过对称设计或配重设计使手腕机构的质心位于腕心处并与小臂杆件交于一点;利用平行四边形机构将小臂驱动电机后移到大臂关节一侧;通过大臂驱动电机与配重以及小臂驱动电机与配重使整个主手位置机构实现重力平衡;在实施时,先做好腕部机构的重力平衡调整,然后再调整位置机构的重力平衡。本发明很好地解决了力感主手完全重力平衡问题。能够实现6自由度力感机器人的完全重力平衡,满足力雅克比方程成立条件,具有良好静态透明性。
Description
技术领域
本发明涉及一种机器人重力平衡方法。特别是涉及一种拟人式6自由度机器人重力平衡方法。
背景技术
(1)目前国际上已经推出的力感机器人,如美国SensAbleTechnologies的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自由度机器人重力平衡方法。
本发明所采用的技术方案是:一种拟人式6自由度机器人重力平衡方法,包括如下步骤:
1)采用拟人式布置方式设置整个6自由度主手机器人,将6自由度主手机器人的第一个关节轴垂直布置,并使所述的第一个关节在重力作用下不会产生绕垂直轴线的回转运动;
2)将手腕3个关节机构呈腕心布置,通过对称设计或配重设计使手腕机构的质心位于腕心处并与小臂杆件交于一点;
3)利用平行四边形机构将小臂驱动电机后移到大臂关节一侧;
4)通过大臂驱动电机与配重以及小臂驱动电机与配重使整个主手位置机构实现重力平衡;
5)在实施时,先做好腕部机构的重力平衡调整,然后再调整位置机构的重力平衡。
步骤2)的实现是首先通过对称设计或配重设计实现腕部3个关节机构的重力平衡设计,使得整个手腕机构的质心位于主手机器人小臂杆件上的一设定点。
步骤4)的实现是采用大臂驱动电机与配重以及小臂驱动电机与配重,通过求解2元一次重力平衡方程,获得两个配重质量。
为了弥补计算等误差的影响,适当调节配重质量或位置。
所述的2元一次重力平衡方程是:
其中,m1是大臂、大臂驱动电机以及大臂配重的总质量,m2是曲柄、小臂驱动电机以及小臂配重的总质量,m3连杆质量,m4是小臂和腕部质量,r1是曲柄、小臂驱动电机以及小臂配重共同的质心距大臂关节轴线的距离,r2是大臂、大臂驱动电机以及大臂配重共同的质心距大臂关节轴线的距离,r4是小臂和腕部的共同的质心距小臂关节轴线的距离,l1是曲柄长度,l2是连杆长度。
本发明的一种拟人式6自由度机器人重力平衡方法,很好地解决了力感主手完全重力平衡问题。能够实现6自由度力感机器人的完全重力平衡,满足力雅克比方程成立条件,具有良好静态透明性。此方法也同样适用于7自由度冗余力感主手的重力平衡设计问题。
附图说明
图1是本发明的大、小臂平衡原理图;
图2是本发明的第三杆件受力分析图;
图3是本发明的第四杆件受力分析图;
图4是本发明的第一杆件受力分析图;
图5是本发明的第二杆件受力分析图。
具体实施方式
下面结合实施例和附图对本发明的一种拟人式6自由度机器人重力平衡方法,做出详细说明。
本发明的一种拟人式6自由度机器人重力平衡方法,包括如下步骤:
1)采用拟人式布置方式设置整个6自由度主手机器人,将6自由度主手机器人的第一个关节轴垂直布置,并使所述的第一个关节在重力作用下不会产生绕垂直轴线的回转运动;
2)将手腕3个关节机构呈腕心布置,通过对称设计或配重设计使手腕机构的质心位于腕心处并与小臂杆件交于一定点;
首先通过对称设计或配重设计实现腕部3个关节机构的重力平衡设计,使得整个手腕机构的质心位于主手机器人小臂杆件上的一设定点。
3)利用平行四边形机构将小臂驱动电机后移到大臂关节一侧;
4)通过大臂驱动电机与配重以及小臂驱动电机与配重使整个主手位置机构实现重力平衡。是采用大臂驱动电机与配重以及小臂驱动电机与配重,通过求解2元一次重力平衡方程,获得两个配重质量,为了弥补计算等误差的影响,可以适当调节配重质量或位置。
所述的2元一次重力平衡方程是:
只要满足该方程式,就能够实现大小臂机构的重力平衡。
其中,m1是大臂、大臂驱动电机以及大臂配重的总质量,m2是曲柄、小臂驱动电机以及小臂配重的总质量,m3连杆质量,m4是小臂和腕部质量,r1是曲柄、小臂驱动电机以及小臂配重共同的质心距大臂关节轴线的距离,r2是大臂、大臂驱动电机以及大臂配重共同的质心距大臂关节轴线的距离,r4是小臂和腕部的共同的质心距小臂关节轴线的距离,l1是曲柄长度,l2是连杆长度。
上述的平衡原理如图1所示,第一设杆件1(包括大臂、大臂驱动电机Ⅰ以及大臂配重)、第二杆件2(包括曲柄、小臂驱动电机Ⅱ以及小臂配重)、第三杆件3(连杆)、第四杆件4(小臂和腕部)的质量分别为m1、m2、m3、m4。第一杆件1的oo1段长度为l1,第二杆件2的oo2段长度为l2,第三杆件3的o2o3段长度为l3,第四杆件4的o1o3段长度为l4。第一杆件1、第二杆件2的质心距离铰链o的长度分别为r1、r2;第三杆件3的质量均布,其质心位于杆件3的中间位置;第四杆件4的质心距离铰链o3的长度为r4。从而可以得到2元一次重力平衡方程,即大小臂机构重力平衡方程。
5)在实施时,先做好腕部机构的重力平衡调整,然后再调整位置机构的重力平衡。
下面结合图1-图5给出本发明的一种拟人式6自由度机器人重力平衡方法中大、小臂机构重力平衡原理具体推导过程如下:
设第一杆件1与x轴的夹角为θ1,第二杆件2与x轴夹角为θ2。第一设杆件1(包括大臂、大臂驱动电机Ⅰ以及大臂配重)、第二杆件2(包括曲柄、小臂驱动电机Ⅱ以及小臂配重)、第三杆件3(连杆)、第四杆件4(小臂和腕部)的质量分别为m1、m2、m3、m4。第一杆件1的oo1段长度为l1,第二杆件2的oo2段长度为l2,第三杆件3的o2o3段长度为l3,第四杆件4的o1o3段长度为l4。第一杆件1、第二杆件2的质心距离铰链o的长度分别为r1、r2;第三杆件3的质量均布,其质心位于杆件3的中间位置;第四杆件4的质心距离铰链o3的长度为r4。
下面分析第一杆件1到第四杆件4各个杆件所受的力和力矩。
图2中m3g为第三杆件3所受的重力,F23x、F23y为第三杆件3受到杆件2施加的作用力,F43x、F43y为第三杆件3受到杆件4施加的作用力,方向如图4所示。
当第三杆件3关于铰链o2力矩平衡,有:
第三杆件3在铰链o2处受力平衡,有:
F23y-m3g-F43y=0(2)
F23x-F43x=0(3)
同理,第四杆件4关于铰链o3力矩平衡:
F14xl4sinθ2+F14yl4cosθ2-m4gr4cosθ2=0(4)
第四杆件4在铰链o3处受力平衡:
F34x-F14x=0(5)
F34y-m4g-F14y=0(6)
第一杆件1关于铰链o力矩平衡:
F41yl1cosθ1-F41xl1sinθ1+m1gr1cosθ1=0(7)
第二杆件2关于铰链o力矩平衡:
F32yl2cosθ2+F32xl2sinθ2-m2gr2cosθ2=0(8)
由于:
l1=l3、l2=l4;F23x=F32x、F23y=F32y;F43x=F34x、F43y=F34y;F14x=F41x、F14y=F41y,
公式(1)-(8)联立,得2元一次重力平衡方程:
只要满足上述重力平衡方程就能够实现大小臂机构的重力平衡。
Claims (3)
1.一种拟人式6自由度机器人重力平衡方法,其特征在于,包括如下步骤:
1)采用拟人式布置方式设置整个6自由度主手机器人,将6自由度主手机器人的第一个关节轴垂直布置,并使所述的第一个关节在重力作用下不会产生绕垂直轴线的回转运动;
2)将手腕3个关节机构呈腕心布置,通过对称设计或配重设计使手腕机构的质心位于腕心处并与小臂杆件交于一点,即首先通过对称设计或配重设计实现腕部3个关节机构的重力平衡设计,使得整个手腕机构的质心位于主手机器人小臂杆件上的一设定点;
3)利用平行四边形机构将小臂驱动电机后移到大臂关节一侧;
4)通过大臂驱动电机与配重以及小臂驱动电机与配重使整个主手位置机构实现重力平衡;重力平衡的实现是采用大臂驱动电机及大臂配重,以及小臂驱动电机及小臂配重,通过求解二元一次重力平衡方程,获得两个配重质量;
5)在实施时,先做好腕部机构的重力平衡调整,然后再调整位置机构的重力平衡。
2.根据权利要求1所述的一种拟人式6自由度机器人重力平衡方法,其特征在于,步骤4)中为了弥补计算误差的影响,调节配重质量或位置。
3.根据权利要求1所述的一种拟人式6自由度机器人重力平衡方法,其特征在于,步骤4)中所述的二元一次重力平衡方程是:
其中,m1是大臂、大臂驱动电机以及大臂配重的总质量,m2是曲柄、小臂驱动电机以及小臂配重的总质量,m3连杆质量,m4是小臂和腕部质量,r1是曲柄、小臂驱动电机以及小臂配重共同的质心距大臂关节轴线的距离,r2是大臂、大臂驱动电机以及大臂配重共同的质心距大臂关节轴线的距离,r4是小臂和腕部的共同的质心距小臂关节轴线的距离,l1是曲柄长度,l2是连杆长度。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201210339981.3A CN102825601B (zh) | 2012-09-13 | 2012-09-13 | 一种拟人式6自由度机器人重力平衡方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201210339981.3A CN102825601B (zh) | 2012-09-13 | 2012-09-13 | 一种拟人式6自由度机器人重力平衡方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN102825601A CN102825601A (zh) | 2012-12-19 |
CN102825601B true CN102825601B (zh) | 2016-03-30 |
Family
ID=47329016
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201210339981.3A Active CN102825601B (zh) | 2012-09-13 | 2012-09-13 | 一种拟人式6自由度机器人重力平衡方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN102825601B (zh) |
Families Citing this family (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103433919B (zh) * | 2013-08-09 | 2016-03-09 | 北京航空航天大学 | 一种基于四杆机构相似的二自由度缩放机构 |
CZ307125B6 (cs) * | 2015-11-30 | 2018-01-24 | Vysoká Škola Báňská-Technická Univerzita Ostrava | Řízení pohybu antropomorfních robotických systémů s mnoha stupni volnosti na základě principů nezávislého řízení pohybu ve směru charakteristických vektorů linearizované dynamické Lagrangeovy rovnice a antropomorfní robotický systém |
CN106737841A (zh) * | 2017-01-03 | 2017-05-31 | 南京工程学院 | 一种力矩自平衡的多连杆配重机构及其平衡算法 |
CN107263478B (zh) * | 2017-07-11 | 2020-03-17 | 西南科技大学 | 遥操作机器人机械手爪夹持力的计算方法及其控制方法 |
WO2022000990A1 (zh) * | 2020-06-30 | 2022-01-06 | 深圳市精锋医疗科技有限公司 | 手术机器人及其控制装置、控制方法 |
CN112757296B (zh) * | 2020-12-28 | 2022-06-03 | 江西明天高科技股份有限公司 | 重力补偿方法及装置 |
Family Cites Families (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
DE10007251A1 (de) * | 2000-02-17 | 2001-08-23 | Kuka Roboter Gmbh | Vorrichtung zum Gewichtsausgleich eines Roboterarms |
RU2262435C2 (ru) * | 2000-11-17 | 2005-10-20 | Хонда Гикен Когио Кабусики Кайся | Двуногий локомоционный робот |
CN1206082C (zh) * | 2002-11-29 | 2005-06-15 | 东南大学 | 6自由度通用型异构式机器人手控器 |
SE0301754D0 (sv) * | 2003-06-13 | 2003-06-13 | Abb Ab | Industrial Robot |
-
2012
- 2012-09-13 CN CN201210339981.3A patent/CN102825601B/zh active Active
Non-Patent Citations (1)
Title |
---|
具有交互夹持力感觉的主从触感装置;李智群;《天津大学学报》;20060630;第38卷(第9期);645-650 * |
Also Published As
Publication number | Publication date |
---|---|
CN102825601A (zh) | 2012-12-19 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN102825601B (zh) | 一种拟人式6自由度机器人重力平衡方法 | |
Hsieh et al. | Design of a parallel actuated exoskeleton for adaptive and safe robotic shoulder rehabilitation | |
Zeiaee et al. | Design and kinematic analysis of a novel upper limb exoskeleton for rehabilitation of stroke patients | |
CN102825596B (zh) | 完全重力平衡的6自由度串联式主手机器人 | |
Carignan et al. | Development of an exoskeleton haptic interface for virtual task training | |
CN107050763B (zh) | 一种新型踝关节康复机器人其控制方法 | |
CN102152314B (zh) | 触感装置中的夹持力反馈系统 | |
CN101444431A (zh) | 辅助微创外科手术机器人的三维力反馈主操作手 | |
CN106730638B (zh) | 基于交互力识别运动意图的欠驱动康复机器人的控制方法 | |
US20200206961A1 (en) | Backdrivable and haptic feedback capable robotic forceps, control system and method | |
Naidu et al. | A 7 DOF exoskeleton arm: Shoulder, elbow, wrist and hand mechanism for assistance to upper limb disabled individuals | |
Sutapun et al. | A 4-DOF upper limb exoskeleton for stroke rehabilitation: kinematics mechanics and control | |
Sarac et al. | AssistOn-Mobile: a series elastic holonomic mobile platform for upper extremity rehabilitation | |
Spagnuolo et al. | Passive and active gravity-compensation of LIGHTarm, an exoskeleton for the upper-limb rehabilitation | |
CN110787024B (zh) | 一种采用无动力补偿关节的肩关节康复外骨骼机构 | |
Zahedi et al. | A Bamboo-Inspired Exoskeleton (BiEXO) Based on Carbon Fiber for Shoulder and Elbow Joints | |
Herbin et al. | Interactive 7-DOF motion controller of the operator arm (ExoArm 7-DOF) | |
Xie et al. | Human-robot coupling dynamic modeling and analysis for upper limb rehabilitation robots | |
Chien et al. | Design of an adaptive exoskeleton for safe robotic shoulder rehabilitation | |
Zhang et al. | Design and kinematic analysis of Co-exoskeleton with passive translational joints for upper-limb rehabilitation | |
Soltani-Zarrin et al. | CLEVERarm: A Novel Exoskeleton for Rehabilitation of Upper Limb Impairments | |
Garrec et al. | A new force-feedback, morphologically inspired portable exoskeleton | |
Dai et al. | Structural Design and Kinematic Analysis of a 6-DOF Wearable Upper Limb Exoskeleton | |
Shi et al. | Design and evaluation of a four-DoF upper limb exoskeleton with gravity compensation | |
Hsieh et al. | Dimensional synthesis of a lightweight shoulder exoskeleton |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
C14 | Grant of patent or utility model | ||
GR01 | Patent grant |