Professional Documents
Culture Documents
2010 2nd International Asia Conference on Informatics in Control, Automation and Robotics
Linkage under-actuated humanoid robotic hand Linkage under-actuated humanoid robotic hand
with control of grasping force with control of grasping force
Wenzeng Zhang, Deyang Zhao, Qiang Chen, Dong Du Wenzeng Zhang, Deyang Zhao, Qiang Chen, Dong Du
Dept. of Mechanical Engineering Dept. of Mechanical Engineering
Key Laboratory for Advanced Materials Processing Technology, Ministry of Education Key Laboratory for Advanced Materials Processing Technology, Ministry of Education
Beijing, China Beijing, China
wenzeng@mail.tsinghua.edu.cn, zdy07@mails.tsinghua.edu.cn wenzeng@mail.tsinghua.edu.cn, zdy07@mails.tsinghua.edu.cn
Laval University[7] and TH-3R Hand [6]. A question was 4 Laval University[7] and TH-3R Hand [6]. A question was 4
5 5
put forward in the literature [8]: “Is computer control put forward in the literature [8]: “Is computer control
needed to perfectly mimic the human hand, or is a simple needed to perfectly mimic the human hand, or is a simple
mechanical design with approximate adaptive grasp (a) (b) (c) mechanical design with approximate adaptive grasp (a) (b) (c)
sufficient?” The TBM hand was proposed as an answer to 1-the “under-actuation” spring; 2-the “force changing” spring; 3-the sufficient?” The TBM hand was proposed as an answer to 1-the “under-actuation” spring; 2-the “force changing” spring; 3-the
the question. Each finger of the hand is connected by a sliders; 4-the base; 5-the lowest link the question. Each finger of the hand is connected by a sliders; 4-the base; 5-the lowest link
spring to the palm. Such a design makes the grasping spring to the palm. Such a design makes the grasping
force on the finger changeable eventually. III. ANALYSIS OF THE FINGER force on the finger changeable eventually. III. ANALYSIS OF THE FINGER
This paper intended to propose a novel under-actuated A. Static Analysis This paper intended to propose a novel under-actuated A. Static Analysis
humanoid hand. Its grasping force should be humanoid hand. Its grasping force should be
controllable. Therefore, the hand should have a A static model is built in this part. The dynamics of controllable. Therefore, the hand should have a A static model is built in this part. The dynamics of
combined function of versatile changeable grasp and the finger are not considered. The friction and force combined function of versatile changeable grasp and the finger are not considered. The friction and force
highly under-actuation. control are ignored here. A model with, where O 1 is the highly under-actuation. control are ignored here. A model with, where O 1 is the
center of the proximal joint shaft, O 2 is the center of the center of the proximal joint shaft, O 2 is the center of the
978-1-4244-5194-4/10/$26.00 ©2010 IEEE CAR 2010 978-1-4244-5194-4/10/$26.00 ©2010 IEEE CAR 2010
distal joint shaft, l 1 is the length of the proximal phalanx Therefore one shall modify J v as: distal joint shaft, l 1 is the length of the proximal phalanx Therefore one shall modify J v as:
i.e. the length of O 1 O 2 , l 2 is the length of the distal ª h1 0 º (9) i.e. the length of O 1 O 2 , l 2 is the length of the distal ª h1 0 º (9)
phalanx, a, b, d, e are all lengths of the links, c is the Jv «A h » phalanx, a, b, d, e are all lengths of the links, c is the Jv «A h »
initial distance between the two sliders, f is the distance ¬ 2¼ initial distance between the two sliders, f is the distance ¬ 2¼
between the center of the slider and O 1 O 2 , f 1 is the Let Ȧ a - Z ș (10) between the center of the slider and O 1 O 2 , f 1 is the Let Ȧ a - Z ș (10)
grasping force on the proximal phalanx, f 2 is the grasping Build a coordinate system fixed on the proximal grasping force on the proximal phalanx, f 2 is the grasping Build a coordinate system fixed on the proximal
force on the distal phalanx, h 1 is the force arm of f 1 with phalanx. Discussion below is set in this coordinate system. force on the distal phalanx, h 1 is the force arm of f 1 with phalanx. Discussion below is set in this coordinate system.
respect to O 1 , h 2 is the force arm of f 2 with respect to O 2 , The 2-DOF finger contains two eccentric crank-slider respect to O 1 , h 2 is the force arm of f 2 with respect to O 2 , The 2-DOF finger contains two eccentric crank-slider
ș a is the rotating angle of the lowest link with respect to mechanisms. A general eccentric crank-slider mechanism ș a is the rotating angle of the lowest link with respect to mechanisms. A general eccentric crank-slider mechanism
the base, ș 1 is the rotating angle of the proximal phalanx, is shown in Fig. 3 where r and L are lengths of links, s is the base, ș 1 is the rotating angle of the proximal phalanx, is shown in Fig. 3 where r and L are lengths of links, s is
ș 2 is the rotating angle of the distal phalanx with respect the distance from the center of the slider to the fixed ș 2 is the rotating angle of the distal phalanx with respect the distance from the center of the slider to the fixed
to the proximal phalanx, and T a is the torque of the motor. hinge, and e is the eccentricity. Let v is the velocity of the to the proximal phalanx, and T a is the torque of the motor. hinge, and e is the eccentricity. Let v is the velocity of the
slider and Ȧ is the rotating velocity of the link 1. slider and Ȧ is the rotating velocity of the link 1.
where A= l1 cos T 2 h2 , B= B. Control of grasping force where A= l1 cos T 2 h2 , B= B. Control of grasping force
f e The motor continues rotating after the finger f e The motor continues rotating after the finger
cos T 2 sin T 2 sin 2T 2 envelopes the object. The “force changing” spring cos T 2 sin T 2 sin 2T 2 envelopes the object. The “force changing” spring
e d 2d e d 2d
a f a produces deformation. Assume T e is the torque of the a f a produces deformation. Assume T e is the torque of the
cos(T1 T a ) sin(T1 T a ) sin 2(T1 T a ) cos(T1 T a ) sin(T1 T a ) sin 2(T1 T a )
b 2b “force changing” spring. It resists directly on the lowest b 2b “force changing” spring. It resists directly on the lowest
link. The motor torque increases to balance the force. The link. The motor torque increases to balance the force. The
The eq. (19) is the matrix the grasping forces on the The eq. (19) is the matrix the grasping forces on the
increment equals to the T e . increment equals to the T e .
finger. Define (ș 1 -ș a ) in B as: finger. Define (ș 1 -ș a ) in B as:
Eq. (2) can be modified as: Eq. (2) can be modified as:
S (20) ªTa Te º S (20) ªTa Te º
< T1 T a (22) < T1 T a (22)
2 t « » 2 t « »
T
¬ s e¼ T T
¬ s e¼ T
One obtains B= One obtains B=
Correspondingly, eq. (18) is rewritten as: Correspondingly, eq. (18) is rewritten as:
f e ª Ta Te AB(Ta Te ) A(Ts Te ) º f e ª Ta Te AB(Ta Te ) A(Ts Te ) º
cos T 2 sin T 2 sin 2T 2 (21) (23) cos T 2 sin T 2 sin 2T 2 (21) (23)
e d 2d « h h1h2 » e d 2d « h h1h2 »
a sin < f cos < a sin 2< f « 1 » a sin < f cos < a sin 2< f « 1 »
« B(Ta Te ) Ts Te » « B(Ta Te ) Ts Te »
b 2b « » b 2b « »
¬ h 2 ¼ ¬ h 2 ¼
A stable grasp refers to that the grasping forces are A stable grasp refers to that the grasping forces are
Ignore the torque of the “under-actuation” spring, Ignore the torque of the “under-actuation” spring,
positive. One can calculate the grasping forces using eq. positive. One can calculate the grasping forces using eq.
ª h2 AB h2 A( B 1) º ª h2 AB h2 A( B 1) º
(19). The stability of the grasp, correspondingly, is « h h Ta Te » (24) (19). The stability of the grasp, correspondingly, is « h h Ta Te » (24)
h1h2 h1h2
determined by f 1 and f 2 as functions of ș 2 and ȥ. f « 1 2 » determined by f 1 and f 2 as functions of ș 2 and ȥ. f « 1 2 »
Let h 1 =35 mm, h 2 =20 mm, l 1 =50 mm, l 2 =30 mm, « BTa (1 B) » Let h 1 =35 mm, h 2 =20 mm, l 1 =50 mm, l 2 =30 mm, « BTa (1 B) »
« h h Te » « h h Te »
a=10 mm, b=18 mm, f=5 mm, e=10 mm, d=15 mm, and ¬ 2 2 ¼ a=10 mm, b=18 mm, f=5 mm, e=10 mm, d=15 mm, and ¬ 2 2 ¼
T a =2 Nm. The f 1 and f 2 are calculated and then shown in Eq. (24) illustrates that direction of the change of T a =2 Nm. The f 1 and f 2 are calculated and then shown in Eq. (24) illustrates that direction of the change of
Fig. 4 and Fig. 5. grasping force is determined by the mechanical design Fig. 4 and Fig. 5. grasping force is determined by the mechanical design
Let f 1 = f 2 = 0, one gets the stability figure shown in and the configuration of the finger. The relationship Let f 1 = f 2 = 0, one gets the stability figure shown in and the configuration of the finger. The relationship
Fig. 6. between the parameters and the force change is concluded Fig. 6. between the parameters and the force change is concluded
as followed. If B>-1, f 2 will increase, and the changing of as followed. If B>-1, f 2 will increase, and the changing of
f 1 is determined by the value of h2 A( B 1) ; If B<-1, f 2 f 1 is determined by the value of h2 A( B 1) ; If B<-1, f 2
will decrease, and f 1 will increase. will decrease, and f 1 will increase.
The direction of the change of grasping force is partly The direction of the change of grasping force is partly
predetermined by the architecture of the finger. The predetermined by the architecture of the finger. The
quantity of the changing is determined by the motor. The quantity of the changing is determined by the motor. The
control of grasping force, therefore, is obtained by control control of grasping force, therefore, is obtained by control
of the motor combing adequate mechanical design. of the motor combing adequate mechanical design.
IV. TH-3L HAND IV. TH-3L HAND
Fig.4. Grasping force f 1 Fig.4. Grasping force f 1
A. Design of 2-DOF finger and 3-DOF finger A. Design of 2-DOF finger and 3-DOF finger
The design of the 2-DOF under-actuated finger is The design of the 2-DOF under-actuated finger is
shown in Fig. 7. The design of 3-DOF finger is shown in shown in Fig. 7. The design of 3-DOF finger is shown in
Fig. 8. Fig. 8.
(a) Front cutaway view (b) Side cutaway view (a) Front cutaway view (b) Side cutaway view
1-base; 2-the proximate phalanx; 3-the distal phalanx; 4-the proximate 1-base; 2-the proximate phalanx; 3-the distal phalanx; 4-the proximate
joint shaft; 5-the distal joint shaft; 6-the gears transmission mechanism; joint shaft; 5-the distal joint shaft; 6-the gears transmission mechanism;
Fig.6. Stability of the grasp 7-the motor; 8-the first link; 9-the second link; 10-the first slider; 11-the Fig.6. Stability of the grasp 7-the motor; 8-the first link; 9-the second link; 10-the first slider; 11-the
second slider; 12-the third link; 13-the first spring; 14-the second spring second slider; 12-the third link; 13-the first spring; 14-the second spring
Fig.7. Design of 2-DOF finger Fig.7. Design of 2-DOF finger
B. Design of TH-3L hand č. CONCLUSIONS B. Design of TH-3L hand č. CONCLUSIONS
The 2-DOF finger and the 3-DOF finger addressed In this paper, a novel under-actuated finger based on The 2-DOF finger and the 3-DOF finger addressed In this paper, a novel under-actuated finger based on
above are included in the TH-3L Hand shown in Fig. 9. A linkages has been presented. Static analysis of it was above are included in the TH-3L Hand shown in Fig. 9. A linkages has been presented. Static analysis of it was
motor is embedded in the palm to actuate the thumb to given and matrix that defines grasping force was obtained. motor is embedded in the palm to actuate the thumb to given and matrix that defines grasping force was obtained.
swing on the side of the hand. The whole hand has 15 The force control was discussed and proved. Finally, the swing on the side of the hand. The whole hand has 15 The force control was discussed and proved. Finally, the
DOFs using 6 motors. designs of the 2-DOF finger, the 3-DOF fingers and DOFs using 6 motors. designs of the 2-DOF finger, the 3-DOF fingers and
TH-3L hand were presented. Future work includes TH-3L hand were presented. Future work includes
manufacture of TH-3L Hand, grasping experiments, manufacture of TH-3L Hand, grasping experiments,
design and integration of the sense system. design and integration of the sense system.
ACKNOWLEDGEMENTS ACKNOWLEDGEMENTS
This research was funded by “National Natural This research was funded by “National Natural
Science Foundation of China” (No. 50905093) and Science Foundation of China” (No. 50905093) and
“Hi-Tech Research and Development Program of China” “Hi-Tech Research and Development Program of China”
(No. 2007AA04Z258). (No. 2007AA04Z258).
REFERENCES REFERENCES
[1] Ulrich, N.T. Methods and Apparatus for Mechanically Intelligent [1] Ulrich, N.T. Methods and Apparatus for Mechanically Intelligent
Grasping. U.S. Pat. No. 4957320. 1988. Grasping. U.S. Pat. No. 4957320. 1988.
[2] V.N. Dubey, R.M. Crowder. Grasping and control issues in [2] V.N. Dubey, R.M. Crowder. Grasping and control issues in
adaptive end effectors. 2004 DETC’04 ASME Design Engineering adaptive end effectors. 2004 DETC’04 ASME Design Engineering
Technical Conferences and Computers & Information in Technical Conferences and Computers & Information in
Engineering Conference. 2004: 1-9. Engineering Conference. 2004: 1-9.
[3] H. Kawasaki, T. Komatsu, K. Uchiyama, et al. Dexterous [3] H. Kawasaki, T. Komatsu, K. Uchiyama, et al. Dexterous
anthropomorphic robot hand with distributed tactile sensor: Gifu anthropomorphic robot hand with distributed tactile sensor: Gifu
hand II. 1999 IEEE Inter Conf. Systems, Man, and Cybernetics. hand II. 1999 IEEE Inter Conf. Systems, Man, and Cybernetics.
1999: 782-787. 1999: 782-787.
[4] Akin, D.L., Carignan, C.R., and Foster, A.W. Development of a [4] Akin, D.L., Carignan, C.R., and Foster, A.W. Development of a
Four-Fingered Dexterous Robot End Effector For Space Four-Fingered Dexterous Robot End Effector For Space
Operations. 2002 IEEE Inter Conf. Robotics and Automation. Operations. 2002 IEEE Inter Conf. Robotics and Automation.
(a) Front cutaway view (b) Side cutaway view 2002: 2302-2308. (a) Front cutaway view (b) Side cutaway view 2002: 2302-2308.
1-the first link; 2-the second link; 3-the first slider; 4-the second slider; [5] Figliolini, G. and Ceccarelli, M. A Novel Articulated Mechanism 1-the first link; 2-the second link; 3-the first slider; 4-the second slider; [5] Figliolini, G. and Ceccarelli, M. A Novel Articulated Mechanism
5-the third link; 6-the forth link; 7-the fifth link; 8-the third slider; 9-the Mimicking the Motion of Index Finger. Robotica 2002, 5-the third link; 6-the forth link; 7-the fifth link; 8-the third slider; 9-the Mimicking the Motion of Index Finger. Robotica 2002,
sixth link; 10-the first spring; 11ˉthe second spring; 12-the third spring Vol.20:13-22,. sixth link; 10-the first spring; 11ˉthe second spring; 12-the third spring Vol.20:13-22,.
Fig.8. Design of 3-DOF finger [6] Wenzeng Zhang, Demeng Che, et al. Super Under-actuated Fig.8. Design of 3-DOF finger [6] Wenzeng Zhang, Demeng Che, et al. Super Under-actuated
Multi-fingered Mechanical Hand with Modular Self-adaptive Multi-fingered Mechanical Hand with Modular Self-adaptive
Gear-rack Mechanism. Industrial Robot: An International Journal Gear-rack Mechanism. Industrial Robot: An International Journal
2009, 36(3) 255–262. 2009, 36(3) 255–262.
[7] Thierry Laliberte and Clement M. Gosselin. Simulation and [7] Thierry Laliberte and Clement M. Gosselin. Simulation and
Design of Under-actuated Mechanical Hands. Mech. Mach. Design of Under-actuated Mechanical Hands. Mech. Mach.
Theory 1998, Vol.33: 39-57. Theory 1998, Vol.33: 39-57.
[8] N.Dechev, W.L. Cleghorn, S. Naumann. Multiple finger, passive [8] N.Dechev, W.L. Cleghorn, S. Naumann. Multiple finger, passive
adaptive grasp prost. Mech. Mach. Theory 2001, Vol.36: adaptive grasp prost. Mech. Mach. Theory 2001, Vol.36:
1157-1173 1157-1173
˄a˅ ˄a˅
(b) (b)
Fig.9. TH-3L hand Fig.9. TH-3L hand