CN108214558A - 一种用于欠驱动机械手的被抓握物体刚度估计方法 - Google Patents
一种用于欠驱动机械手的被抓握物体刚度估计方法 Download PDFInfo
- Publication number
- CN108214558A CN108214558A CN201810050096.0A CN201810050096A CN108214558A CN 108214558 A CN108214558 A CN 108214558A CN 201810050096 A CN201810050096 A CN 201810050096A CN 108214558 A CN108214558 A CN 108214558A
- Authority
- CN
- China
- Prior art keywords
- finger
- rigidity
- motor
- deformation
- grabbed
- 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.)
- Granted
Links
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J19/00—Accessories fitted to manipulators, e.g. for monitoring, for viewing; Safety devices combined with or specially adapted for use in connection with manipulators
- B25J19/02—Sensing devices
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01N—INVESTIGATING OR ANALYSING MATERIALS BY DETERMINING THEIR CHEMICAL OR PHYSICAL PROPERTIES
- G01N3/00—Investigating strength properties of solid materials by application of mechanical stress
- G01N3/40—Investigating hardness or rebound hardness
Landscapes
- Engineering & Computer Science (AREA)
- Mechanical Engineering (AREA)
- Robotics (AREA)
- General Health & Medical Sciences (AREA)
- Analytical Chemistry (AREA)
- Biochemistry (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Immunology (AREA)
- Pathology (AREA)
- Chemical & Material Sciences (AREA)
- Life Sciences & Earth Sciences (AREA)
- Health & Medical Sciences (AREA)
- Manipulator (AREA)
- Prostheses (AREA)
Abstract
一种用于欠驱动机械手被抓物体刚度估计方法。机械手指机构需要安装两组传感器,分别是在手指末端表面的力传感器和电机末端的编码器。该方法根据欠驱动机械手机构在自由空间和接触空间里运动学模型和力学模型的差异,通过读取抓握接触力信号与电机编码器信息,计算出被抓物体与机械手指的等效刚度,然后解耦计算出被抓物体的刚度。本发明主要应用于欠驱动机械手,抓握不同的物体时能更准确的识别出物体的刚度。
Description
技术领域
本发明属于仿人机械手技术领域,特别涉及一种用于欠驱动机械手估计被抓握物体 刚度的方法。
背景技术
人手具有强大的自主控制能力,在抓握物体时,通常是根据观察被抓物体的软硬特 征,根据人的经验,调整人体的骨骼肌,顺应地抓握不同刚度的物体,如以较小的力柔性地 抓握软物体,以较大的力刚性地抓握硬物体,并且由于人手皮肤上拥有大量的感知神经,通 过触感信息和视觉信息一起形成反馈机制,可以较好的控制抓取力和抓取精度,完美的完成 抓握动作。然而,机械手在设计好后,刚度通常是固定不变的,如果想获得同人手类似的刚 度变化,只有通过主动变刚度控制来实现。否则,若解码不当,当假肢手抓取物体时,过大 的力会引起一些被抓物体的变形或者甚至被破坏,而另一方面,过小的抓握力会导致抓取不 稳定。
要实现变刚度控制,首先必须知道被抓物体的刚度信息,但是被抓对象的刚度很难 直接测量,只能通过假肢手进行间接测量。目前用于机器人的刚度估计方法一般有根据固有 振动频率信号处理法以及时域分析法。第一种方法测量比较准确,但是常常用于离线分析, 并且需要力反馈具有欠阻尼特性;第二种方法可以在线使用,通过定义的方法进行计算,但 是需要较长时间才能得出准确的刚度信息。此外,这两种方法都是针对刚性的机械手,并且 被抓物体都为实验装置,没有应用于日常物体的报道。
发明内容
本发明针对现有技术存在的上述不足,提出一种用于欠驱动机械手被抓物体刚度估 计方法。机械手指机构需要安装两组传感器,分别是在手指末端表面的力传感器和电机末端 的编码器。该方法根据欠驱动机械手在自由空间和接触空间里运动学模型和力模型的差异, 通过读取抓握接触力信号与电机编码器信息,计算出被抓物体与机械手指的等效刚度,然后 解耦计算出被抓物体的刚度。
本发明是通过以下技术方案实现的:
本发明包括以下步骤:
步骤一,建立欠驱动机械手的运动学模型,具体为:根据欠驱动机械手的几何特征关系,分别建立在自由空间和接触空间中抓握点运动位置与电机转角的函数关系;
步骤二,假定欠驱动假肢手在抓握过程分为物体变形阶段和机械手指变形阶段,在 物体变形阶段时,根据步骤一中的欠驱动机构的在运动空间的运动学关系建立物体变形量与 电机转角的函数关系;
步骤三,在机械手指变形阶段时,根据接触空间欠驱动机械手的力输出特性与分配 关系,建立在接触空间中抓握点的抓握接触力与电机输出力矩之间的函数关系;
步骤四,根据步骤二和步骤三的函数关系计算***总体等效刚度;
步骤五,假肢手抓握硬度极大的物体,物体的变形量极小可忽略不计,读取抓握接触 力信息与电机编码器信息,此时根据步骤四的计算的***总体等效刚度即为假肢机构的手指 等效刚度;
步骤六,根据步骤四计算的***总体等效刚度和步骤五得到的手指等效刚度求解出 被抓握物体刚度的计算公式;
步骤七,假肢手抓握其他未知刚度的物体,读取此时的抓握接触力信息与电机编码 器信息,根据步骤六的公式解耦计算出准确的被抓物体的刚度信息。
附图说明
图1为典型欠驱动机械手结构示意图
图2为欠驱动机械手接触到被抓物体,假定机械手不变形而被抓物体变形的示意图。
图3为欠驱动机械手接触到被抓物体,假定机械手变形而被抓物体不变形的示意图。
具体实施方式
下面结合附图和具体实施方式对本发明进行详细说明。
建立欠驱动机械手的数学解析模型,推算总体等效刚度、手指刚度和被抓物体刚度 的函数关系,并估算出被抓物体的刚度的具体步骤如下:
步骤一,欠驱动机械手的运动学模型的建立:
本发明所述的一种具有快速反射抓取功能的多模式欠驱动仿人手指装置的实施例, 其原理结合图1进行阐述。
如图1所示为一种欠驱动机械手机构,在建立坐标原点为O点的直角坐标系下,封闭四连杆多边形OEAB和OABD可用矢量法表达为:
其中,li表示第i根连杆的杆长(i=1,2,3,4,5),θi和表示第i根杆到x轴正半轴之 间的夹角和速度(逆时针方向),θi0表示θi在初始位置时的角度,θij表示第i根杆到第j根杆 之间的夹角,ψ、c1均为机构初始角度和机构参数。
由于欠驱动的特点,其运动状态一般分为自由空间和接触空间。
在机械手未接触物体时,如图1所示,杆1是输入杆,直接与驱动电机连接,杆2 和杆3(杆6)是耦合运动的,近指节的速度和杆2的速度相同,远指节的速度与杆3的速度 相同。根据式(1)和(2),其运动规律为,输入杆和输出杆之间的速度关系为:
其中表示第m个指节的速度(m=1,2),Mt1与Mt2是欠驱动机构运动学的相关参数,在本例中具体为:
在图1所示的本例中,远指节和近指节的运动关系接近1:1,并且近指节、远指节和输 入杆的运动比例关系近似为1:1:1.6。因此近指节和远指节与输入杆(电机)的角速度关系可 以写为:
在机械手接触物体时,机构进入接触空间,近指节(杆2)碰到物体被固定,弹性元件开始变形并释放欠驱动***的一个自由度,此时,远指节旋转角速度与输入角速度的关系 为:
步骤二,建立物体弹性变形阶段的物体变形量与电机转角的函数关系:
抓握时,要从电机旋转信息推导物体的变形量是十分复杂的,因为被抓握物体和手 指都会发生变形,生活中被抓握物体的刚度一般呈非线性特征。给予一定电压驱动手指运动, 在t0时刻与被抓握物体接触,并在t2时刻达到力平衡状态。若驱动电压较小,则可以在短时 间内达到平衡,此时手指指尖和物体之间接触点的切向滑动距离也很小。因此,假设在整个 过程中手指指尖的力方向垂直于手指的接触表面,编码器记录的电机旋转角度为Δθ1,需要 计算的物体变形量为δ。
可以将被抓握物体等效成弹簧阻尼***,因此,可将手指抓握过程分为两个阶段:物体弹性变形阶段和手指变形阶段。假设在第一阶段中,仅发生物体的弹性变形,手指机构不变形,物体变形达到最大值并保持稳定。第二阶段时,假设仅发生手指机构变形而物体不变形。这种假设与实际情况并不矛盾,因为初始时刻和稳定时刻的状态都与实际情况相符,仅仅只是将抓握变形的过程理想化,这样假设的目的是要从手指机构模型推导出更为准确的 刚度信息。
首先在物体弹性变形阶段,假设手指机构不变形,那么手指的运动特性属于耦合运 动阶段。如图2所示,此时电机的旋转角度为Δθ1-1,手指机构从O-A1-I1运动到O-A2-I2。此 时,接触点从H1移动到H2,手指末端接触抓握力为F1,同时物体受到弹性形变的反力为R1。
由于给予的驱动电压为恒定值,电机驱动速度也为恒定,此阶段中,电机转动微小角度为Δθ1-1,并且此时电机的运动速度为所以根据公式(7),在这段时间内,手指近指节 和远指节运动旋转角度为:
根据图2,通过点A2作一根线段A2I0与A1I1平行,因此∠I0A2I2=Δα2,将物体的 变形δ(H1H2)依据线段A2I0分为δ1和δ2两部分。因为变形角度非常小,根据几何关系有:
A1A2=2l2sin(Δα1/2)≈Δα1l2 (10)
其中,点A2到线段A1I1的距离为δ1,可以得到:
δ1=cos(α2-Δα2/2)A1A2≈Δα1l2cosα2 (11)
同时,点H2到A2I0的距离为δ2,即为:
δ2=lA1H1tanΔα2≈Δα2lA1H1 (12)
式中A1H1长度为手指与物体的接触点到远指节中关节轴的距离。
因此,物体变形量δ为:
δ=δ1+δ2=Δα1l2cosα2+Δα2lA1H1 (13)
根据式(7),可以将式(13)表述为物体变形量δ和电机的旋转角度Δθ1-1,即:
δ/JT1=Δθ1-1 (14)
其中:JT1=A(l2cosα2+lA1H1) (15)
步骤三,建立机械手指变形阶段的抓握接触力与电机输出力矩的函数关系:
由于欠驱动机构的特殊性,当欠驱动机构与物体接触时进入接触空间,每个指节仍 然可能发生局部运动,在该阶段中,手指机构仅发生局部微小变形,且被抓握的物体不变形。 如图3所示,假设在该阶段中,电机转动微小角度为Δθ1-2,此时接触点从H3滑动到H2,并且手 指机构的等效位置从O-A2-I2移动到O-A3-I3。因为在该阶段物体变形量保持恒定,所以抓握接 触力的值保持为F1,根据机构的几何关系,抓握接触力F1和电机输出力矩τ之间的关系为:
或者表示为:
式中:JT2=l1cosα2(sinθ12+cosα2cotθ24) (18)
步骤四,计算***总体等效刚度:
根据上述过程,在抓握时,计算整个***总体等效刚度KE为:
步骤五,估算欠驱动机构的手指机构刚度:
定义手指机构的等效刚度为KT,当机械手抓握不可变形的超硬物体,如陶瓷杯,金属杯等,此时KO≈+∞,抓握接触力为FT,电机的转角为ΔθT,那么这种情况下测得的整个***的刚度为手指机构的等效刚度,即:
步骤六,推出被抓握物体刚度的计算公式:
定义被抓握物体的刚度为KO,因此在整个过程中,电机的总运动角度为:
合并公式(19)和(21),可推导出被抓握物体的刚度KO为:
步骤七,假肢手抓握其他未知刚度的物体,读取此时的抓握接触力信息与电机编码 器信息,根据步骤六的公式(22)解耦计算出准被抓物体的刚度信息。
Claims (1)
1.一种用于欠驱动机械手的被抓握物体刚度估计方法,其特征在于:所述估计被抓物体刚度的方法包括以下步骤:
第一步:建立欠驱动机械手的运动学模型和力学模型,具体为:根据欠驱动机械手的几何特征关系,分别建立在自由空间和接触空间中各个指节运动位置与电机转角的函数关系:
其中:P1,P2和Mt1分别表示欠驱动机构运动学参数;
第二步:将抓握过程分解为物体变形阶段和机械手指变形阶段,在物体变形阶段时,根据步骤1中的欠驱动机构的在运动空间的运动学关系建立物体变形量δ与此时电机转角Δθ1-1的函数关系,其中电机转角Δθ1-1由安装在电机末端的编码器采集读取:
δ/JT1=Δθ1-1 (3)
其中:JT1表示欠驱动机构运动学参数;
第三步:在机械手指变形阶段时,在机械手指变形阶段时,根据接触空间欠驱动机械手的力输出特性与分配关系,建立在接触空间下抓握点的抓握接触力F1与电机输出力矩τ之间的函数关系,其中抓握接触力F1由安装在手指末端表面的力传感器采集读取:
其中:JT2表示欠驱动机构运动学参数;
第四步:根据步骤2和步骤3的函数关系计算***总体等效刚度KE:
第五步:假肢手抓握硬度极大的物体,读取抓握接触力信息与电机编码器信息,此时,抓握接触力为FT,电机的转角为ΔθT,此时根据步骤4的计算的***总体等效刚度KE即为假肢机构的手指等效刚度KT:
第六步:根据步骤4计算的***总体等效刚度和步骤五得到的手指等效刚度求解出被抓握物体刚度KO的计算公式:
第七步:假肢手抓握其他未知刚度的物体,读取此时的抓握接触力信息与编码器的电机转角信息,根据公式(7)解耦计算出被抓物体的刚度信息。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810050096.0A CN108214558B (zh) | 2018-01-18 | 2018-01-18 | 一种用于欠驱动机械手的被抓握物体刚度估计方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810050096.0A CN108214558B (zh) | 2018-01-18 | 2018-01-18 | 一种用于欠驱动机械手的被抓握物体刚度估计方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN108214558A true CN108214558A (zh) | 2018-06-29 |
CN108214558B CN108214558B (zh) | 2021-04-06 |
Family
ID=62667669
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201810050096.0A Active CN108214558B (zh) | 2018-01-18 | 2018-01-18 | 一种用于欠驱动机械手的被抓握物体刚度估计方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN108214558B (zh) |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111230859A (zh) * | 2018-11-29 | 2020-06-05 | 株式会社安川电机 | 特性评估***、特性评估方法和程序 |
CN114714383A (zh) * | 2022-03-16 | 2022-07-08 | 四川大学华西医院 | 一种解耦三自由度指掌可变型抓取机构 |
Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2004223663A (ja) * | 2003-01-24 | 2004-08-12 | Doshisha | インピーダンス制御装置、およびインピーダンス制御プログラム |
US20100095799A1 (en) * | 2008-10-21 | 2010-04-22 | Albin Scott R | End effector for mobile remotely controlled robot |
CN102896637A (zh) * | 2012-05-11 | 2013-01-30 | 中南大学 | 一种具有快速反射抓取功能的耦合自适应欠驱动仿人手指装置 |
CN103273498A (zh) * | 2013-06-09 | 2013-09-04 | 沈阳工业大学 | 一种可变刚度的柔性机械手 |
CN103430005A (zh) * | 2011-03-30 | 2013-12-04 | 日野自动车株式会社 | 在线硬度检测装置、在线硬度检测方法以及机械手 |
CN105892331A (zh) * | 2014-11-25 | 2016-08-24 | 中南大学 | 一种用于电机驱动机械手的抓握力估计与控制方法 |
CN105945979A (zh) * | 2016-07-08 | 2016-09-21 | 上海航天控制技术研究所 | 对欠驱动二指爪机构进行柔顺控制的方法 |
-
2018
- 2018-01-18 CN CN201810050096.0A patent/CN108214558B/zh active Active
Patent Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2004223663A (ja) * | 2003-01-24 | 2004-08-12 | Doshisha | インピーダンス制御装置、およびインピーダンス制御プログラム |
US20100095799A1 (en) * | 2008-10-21 | 2010-04-22 | Albin Scott R | End effector for mobile remotely controlled robot |
CN103430005A (zh) * | 2011-03-30 | 2013-12-04 | 日野自动车株式会社 | 在线硬度检测装置、在线硬度检测方法以及机械手 |
CN102896637A (zh) * | 2012-05-11 | 2013-01-30 | 中南大学 | 一种具有快速反射抓取功能的耦合自适应欠驱动仿人手指装置 |
CN103273498A (zh) * | 2013-06-09 | 2013-09-04 | 沈阳工业大学 | 一种可变刚度的柔性机械手 |
CN105892331A (zh) * | 2014-11-25 | 2016-08-24 | 中南大学 | 一种用于电机驱动机械手的抓握力估计与控制方法 |
CN105945979A (zh) * | 2016-07-08 | 2016-09-21 | 上海航天控制技术研究所 | 对欠驱动二指爪机构进行柔顺控制的方法 |
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111230859A (zh) * | 2018-11-29 | 2020-06-05 | 株式会社安川电机 | 特性评估***、特性评估方法和程序 |
CN114714383A (zh) * | 2022-03-16 | 2022-07-08 | 四川大学华西医院 | 一种解耦三自由度指掌可变型抓取机构 |
CN114714383B (zh) * | 2022-03-16 | 2023-06-09 | 四川大学华西医院 | 一种解耦三自由度指掌可变型抓取机构 |
Also Published As
Publication number | Publication date |
---|---|
CN108214558B (zh) | 2021-04-06 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
Li et al. | Gaussian process regression for sensorless grip force estimation of cable-driven elongated surgical instruments | |
KR101549818B1 (ko) | 로봇 핸드 및 그 제어방법 | |
Chang et al. | Sensor glove based on novel inertial sensor fusion control algorithm for 3-D real-time hand gestures measurements | |
Santaera et al. | Low-cost, fast and accurate reconstruction of robotic and human postures via IMU measurements | |
CN102363301A (zh) | 机器人拟人手指自适应指尖力跟踪控制方法 | |
Back et al. | Control a contact sensing finger for surface haptic exploration | |
Rhee et al. | Door opening control using the multi-fingered robotic hand for the indoor service robot | |
Ding et al. | A novel motion estimate method of human joint with EMG-driven model | |
CN108214558A (zh) | 一种用于欠驱动机械手的被抓握物体刚度估计方法 | |
Wang et al. | Development of human-machine interface for teleoperation of a mobile manipulator | |
Liu et al. | HIT prosthetic hand based on tendon-driven mechanism | |
SaLoutos et al. | Design of a multimodal fingertip sensor for dynamic manipulation | |
CN110103226B (zh) | 一种辅助机器人控制方法及*** | |
Zhang et al. | A small-scale, rat-inspired whisker sensor for the perception of a biomimetic robot: Design, fabrication, modeling, and experimental characterization | |
da Fonseca et al. | Stable grasping and object reorientation with a three-fingered robotic hand | |
Collins et al. | Force/torque sensing for soft grippers using an external camera | |
KR20080114197A (ko) | 착용형 다관절 로봇암 및 착용형 다관절의 로봇암의 위치 이동 방법 | |
Khalil et al. | Integrated multisensory robotic hand system for deformable object manipulation | |
Jiang et al. | An inverse-kinematics table-based solution of a humanoid robot finger with nonlinearly coupled joints | |
Ma et al. | Modeling human hand and sensing hand motions with the five-fingered haptic glove mechanism | |
Li et al. | Simulation results for manipulation of unknown objects in hand | |
KR101568084B1 (ko) | 이족보행로봇의 보행 모방 제어장치 | |
De Souza et al. | Towards comprehensive capture of human grasping and manipulation skills | |
Wang et al. | Integrating sensor fusion for teleoperation control of anthropomorphic dual-arm robots | |
TAŞAR et al. | Modeling, Simulation and Control of Prosthetic Hand using Sim Mechanics |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |