Document 14041852

advertisement
Proceedings of the 1998 IEEE
InternationalConference on Robotics & Automation
Leuven, Belgium ● May 1998
Haptic Display for Object Grasping and Manipulating in Virtual Environment
Hitoshi
Maekawa
John M. Hollerbach
Departmentof Computer Science, Universityof Utah
SaltLake City, Utah 84112 USA
However, in reviewing conventional haptic display
devices, they do not satisfy the requirements described
above. Namely, a conventional haptic display device does
not provide a large workspace [7] for manipulation or is
capable of generating only one of the external force
[1][3][5] or the internal force [2].
Abstract
A haptic display for grasping and manipulating virtual
objects in a CAD environment is investigated for the
development
of rapid proto~ping
technology.
The
operator receives the sensation of contacting and tracing
of the surface of the virtual object, and of grasping and
manipulating the object from the haptic display. Afler the
control of the haptic dispiqv is formulated,
it is
implemented on the Sarcos Dexterous Arm Mizrter. The
proposed haptic display is experimentally con@med to
provide realistic sensation that enables the operator to
grasp and manipulate
the virtual object easily as
intended.
For this problem, the authors employed the %rcos
Dexterous Arm Master shown in Fig. 1 as the haptic
interfaee. The master artn provides seven joints at the
arm, one at the index finger and two at the thumb. The
operator grabs the hand rest at the wrist and inserts the
index finger and thumb into the finger attachment while
interacting with the master arm. Since the joints of the
master arm are capable of force control, it is possible to
apply specified forces at the wrist, index and thumb of
the operator.
1. Introduction
In this paper, a haptic display is presented for grasping
and manipulating of virtual objects designed in an
advanced CAD modeling system, Utah’s Alpha_l [4].
2. Fundamental
formulae for virtual grasping
and manipulating
The final goal of this research is a realization of realistic
haptic sensations for interactive rapid prototyping in a
virtual CAD environment.
The hope is to reduee the
duration of the cyclic iteration of design, evaluation and
modification
of prototypes.
A fimdamental
task is
considered of grasping of a virtual object by two fingers,
manipulating it to a &sired position and orientation and
releasing the object at a new location.
In the proposed haptic display, the following assumptions
are made for providing the sensation of grasping and
manipulating to the operator by the master arm:
In order to apply the sensation
of grasping
and
manipulating the virtual object to the operator, the haptic
display deviee should provide force-ecmtrollable degrees
of freedom at the arm and hand as well as large
workspace where the object is manipulated. Additionally,
both of the following two forces, namely, the external
force and the internal force need to be generated:
External forw
The net force-moment appiied to the operator that
does not cancel in the operator’s body. This force is
caused by an object’s gravity load, inertia, contact
with the environment, and so on.
Internal force
The force applied at the fingers that cancels together
in operator’s body. This force is caused by squeezing
the object by the fingers.
Fig. 1 Sarcos Master Dexterous Am.
0-7803-4300-x-5/98
$10.0001998
IEEE
2566
1. Only two points, at the tips of the index finger and the
thumb of the master arm, interact with the virtual
object.
2. The object is fixed in the absolute coordinate system
when it is not grasped by the master arm.
3. When only one fingertip makes contact on the object,
the contact is fiictionless.
4. When an object is grasped by two fingers, each
fingertip sticks on the object surface without slip.
5. Although the object is grasped only by two fingers, its
rotation around the axis that connects two fingertips is
constrained.
6. While manipulating the object, its dynamics due to
inertia is omitted.
As a preparation
vector g: e %3, which consists of roll, pitch and yaw
(RPY) angles of the object coordinate system relative to
the absolute coordinate system, The orientation of the
wrist of the master arm is represented by RPY angles
@ E$J13relative to the absolute coordinate system.
The rotation matrix R(g:) E 9t3x3 that converts the
vector described in the absolute coordinate system to the
corresponding vector described in the object coordinate
system is defined as follows:
Cycz C*SZ
+ Sxsycz SXsz– CXSYC2
- Cysz Cxcz– S,svsz Sxcz+ Cxsysz
R(c)=
Sy
for the formulation, two coordinate
– S*CY
(1)
C2CY
where,
systems. namely the absolute coordinate
system o“ Xayazo and the object coordinate system o“ - x“y”z”
fixed on the object, are defined as shown in Fig. 2. The
superscriptsa and o represent the parameters described
in the absolute and object coordinate systems,
respectively. Also the subscripts i. L w and o ~present
the parameters for index, thumb, wrist and object,
respectively.
system o“, The object orientation is represented by
*X’
Virtual object
z“
o
“iii
s, = sin~, ,
SY= sin #Y,
s, = sin ~Z
[
I
Y
/0=
x=
(3)
For the index finger and thumb, the penetrations of the
fingertips into the object in object coordinate system p:,
p; e 913are determinedfrom the fingertipposition
x:,
x: relative to the object coordinate system by the
function ~ thatis definedbasedon the geometryof the
objectstiace as:
p;=
‘t
(2)
When a fingertip of the master arm collides with the
virtual obje~ the penetration of the fingertip into the
object is calculated. The penetration is the minimum
distance between the fingertip and the object surface.
Therefore, the penetration is directed toward the smface
normal of the object.
P,” = 8(%0
\z”l
–x:)
x; = I?(g: )(x: – x:)
the vector x: GV13to the origin of the object coordinate
I--V
Cz= cosgz
x; = R(&)(x:
X; E iR3, respectively, The object position is located by
index
Cy=Cosgy,
Consequently, the positions of the tip of the index finger
and of the thumb x;, x; E 913 in the object coordinate
system are described as:
The positions of the tip of the index finger, the tip of the
thumb and the wrist of the master arm are represented in
the absolute coordinate system by the vectors x:, x;,
Master arm
C@’x .
Cz =
/
8(X;)
(4)
(5)
The penetration vector of the index finger and thumb
relative to the object coordinate system is converted to
that in the absolute coordinate system p:, p: e 933by
Ya
rotational transformation between coordinate systems as:
Absolute coordinate system
Fig. 2 Coordinate system describing the position,
orientation of master arm and object.
2567
p: = R-’(~)p:
(6)
P: = R-’(E)P;
(7)
3. Haptic display for object grasping and
manipulating
The slate tmnsition diagram of the haptic display is
shown in Fig. 3. The control consists of five states,
namely FREE, INDEX CONTACT, THUMB CONTACT,
GRASP and MANIPULATE. In order to create a haptic
sensation of object grasping and manipulating, the
posture of the operator’s hand and arm is measured from
the joint angles of the master arm. The joint torque is
controlled according to the current state and the
geometric relation between the master arm and virtual
object as described next.
FREE state
In this state, no interaction exists between the operator
and the object. When the tips of both the index finger and
the thumb of the master arm are positioned outside the
virtual object, the control is in the FREE state. No force
or moment is applied to the operator while controlling
the joint torques of the master arm t’ e 91” (A! Number
of joints) to ouly counteract the gravity loading on the
master arm:
(8)
~J = ~: (eJ)
where
?: e x N
compensation
is
the
of the master
joint
torque
arm which
for
gravity
is determined
from the joint position @ c !ll~.
INDEX CONTACT, THUMB CONTACT state
In these states, the operator touches and traces the object
surface with one fingertip while fiAing frictionless
contact. The object is still fixed in the absolute coordinate
system. When the tip of the index finger moves into the
internal region of the virtual obj~ the control transits
from the FREE to the INDEX CONTACT state. Based
on the contact model that contains nonlinear stiffness and
damping [6], the cmntaeting force at the index finger
fi e%’ that realizes the sensation of stable contact is
exerted according to the penetration of the tip of the
index finger p; into thevirtualobjectas follows:
(9)
where
KC is
a constantspeci&ingthe nonlinearstitTness
of the contactthatthe force is proportionalto the squareroot of the penetration.On the other hand BC is a
constant for the nonlinear damping that the force is
proportionalto the productof the differentiationand the
square-rootof the penetration.Sincethe contactingforce
is exertedin the samedirectionof the penetrationof the
fingertip that is parallel to the surface normal of the
virtual object, the operator senses frictiordesscontact
while tracing the surEace of the object with the index
finger.
The contact force at the index finger is converted to the
corresponding joint torque of the master arm t~ by the
Jacobian matrix J, ~ 913XN,which relates the deviation
FREE
of the index fingertip position x; and the joint position
ID
t9J while appending the gravity compensation torque:
INDEX
THUMB
CONTACT
CONTACT
rJ = J,T~” +r;(&)
(lo)
(11)
TC
On the other hand, the state transits from FREE to
THUMB CONTACT when the tip of the thumb moves
into the internal region of the object. In the THUMB
CONTACT state, as well in the INDEX CONTACT state,
the contact force at the thumb is determined according to
its penetration and converted into joint torque.
IC:
ID:
TC:
TD:
Eq. (28):
Eq, (29):
Index contact on object
Index detach from object
Thumb contact on object
Thumb detach from object
Fingertip separates
Reactive force counteracts the gravity
Fig. 3 State transition of the haptic display.
The control transits to the FREE state when the fingertip
moves outside of the object.
GRASP state
In this state, both the in&x finger and the thumb stick on
the virtual object without slip and grasp it. However, the
object is constrained by virtual springs that suspend the
object in the absolute mordimte system. When the other
fingertip that is separated from the object at INDEX
CONTACT or THUMB CONTACT state comes into the
internal region of the virtual object, the control transits to
the GRASP state. At the moment of transition to the
GRASP state, the position of the index finger, thumb,
and wrist, and the position and orientation of the object
for the absolute coordinate system is preserved as ~,
x;,
x;, x;,
~
●913, respectively. Also,
(17)
(I%l=l%l=lgl=l)
The constraint that vectors ~
with ~
the following
vectors ~,
~,
~ e 9i3 relative to the
coordinate system are calculated and preserved.
to g
(18)
to & should coincide
in the object coordinate system is
expressed as:
object
From this equation, the rotation matrix 11(<~) Mween
(12)
the absolute and object coordinate Wstems is given as:
Reviewing Eq. (l), the orientation of the object g: is
determined as follows, where ~
As illustrated in Fig. 2, ~,
to each other. Vector ~
~
and ~
are orthogonal
of matrix R(~~ ) at the m-th column and n-th row.
is aimed toward the tip of the
index finger from that of the thumb. Vector ~
g= (
is in the
atan2 R3,,
plane that contains the tip of the index finger, thumb and
wrist.
1
Additionally, the position of the midpoint between the
fingertips relative to the object coordinate system is
preserved as x: e !K3:
represents the element
R,,
(21)
co~atan2(- ~,, R,,)) 1
a~2(–%1,
Rll )
The object position x: is determined from the position
of the fingertips x:,
x;, the object orientation
~, and
the position of the midpoint of the fingertips ~
presemed at the transition to the GRASP state using Eq.
(15):
(15)
While in the GRASP or MANIPULATE state, the
position and orientation of the virtual object are
determined according to the motion of the master arm so
that ~ to ~ and Z: is kept constant in the object
(22)
After determining the position and orientation of the
object through this process, the force and moment that
apply the sensation of grasping to the operator are
determined.
coordinate system. As a result, the rotation of the object
around ~ is artificially constrained although the object
is grasped by only two fingers.
After preserving the above parameters at the transition,
the position and orientation of the virtual object are
determined according to the configuration of the master
arm while it is moved by the operator. At first, vectors
~, ~, ~ ~iH3, which correspond to ~ to @ but
relative to the absolute coordinate system, are determined
from the position of the tips of the index finger x: and
the thumb
X:
and of the wrist x; as:
Since the object is constrained by virtual springs, the
reactive force and moment are exerted at the wrist of the
master arm. The force and moment at the wrist f:,
@
E 913 relativeto
the absolutecoordinatesystemare
made proportionalto the translationand rotationof the
object from the initialcondition at the transitionto the
GRASP state:
[:]=
ffp’)]
(23)
(16)
In above equation, Ku and KO~specify the translational
2569
and rotational stiffnesses that constrain the object motion.
(25)
Besides the force and moment exerted at the wrist, a
grasping force is exerted between the tips of the index
finger and the thumb in order to provide the sensation of
squeezing the object. As well as the contact force exerted
at the INDEX CONTACT and THUMB CONTACT
states, the grasping force fg that consists of nonlinear
stiffness and
damping
specified by
Kg and
{1
x:
Jw=—
(26)
(27)
B~,
respectively, is exerted according to the distance between
the fingertips X; – X; as:
The GRASP state transits to the FREE state when the
distance between the fingertips increases beyond the
initial distance plus the hysteresis for grasping (D in Fig.
4) as:
(24)
In this case, the object returns to its initial position and
The grasping force that varies for quasi-static change of
the distarvx between the fingertips is illustrated in Fig. 4.
When the control transits to the GR4SP state at A where
the fingertip distance is ~ – x,” , the grasping force is
orientation X;,
~
preservedat the transitionto the
GRASP state.
On the other hand, the GRASP state transits to the
MANIPULATE state when the reactive force produced
by the stiffness increases to counteract the gravity of the
object as:
immediately exerted (A+B). While in the GRASP state,
the grasping force increases nonlinearly as the virtual
object is squeezed (&K). In case the object is going to
be released, the grasping force decreases to zero as the
fingertips separate (C-+B-+D-+E). The control transits
to the FREE state at D and the object is considered to be
released. Due to the hysteresis of the grasp db (A-D), the
f;.gf
’+gl’
(29)
where g“ ~ $t3, MO represent the gravity acceleration
relative to the absolute coordinate system and the mass of
the virtual object, respectively. Since the gravity load of
the object is applied to the operator in the
MANIPULATE state as mentioned later, the vertical
force applied to the operator varies continuously at the
transition from GRASP to MANIPULATE states.
control will not transit from FREE to GRASP state again
until the operator squeezes the fingers to A. Therefore,
undesired frequent transition between FREE and GRASP
state are prevented.
Both the reactive force and moment at the wrist and the
grasping form at the fingers are converted to
corresponding joint torques by the Jacobian matrix
JW e M’xN for the motion of the wrist and ~, Gitilx~ for
MANIPULATE state
In this state, the operator can freely manipulate the object
without any constraint while sensing the gmvity load of
the virtual object. Instead of the reactive force-moment
exerted by the stiffness in the GRASP state, the forcemoment due to the gravity load of the object is exerted at
the wrist as:
the distance betweenfingertips as:
~asping
‘R
zh9J
force f.
where X; ~ %3 represents the position of the object’s
center of gravity relative to the object coordinate system.
The inertia force-moment exerted by the object
acceleration is currently omitted to simpli~ the control.
,%++d,
to the GRASP state, the position and orientation
~ ‘ingtiip$yofSimilar
the object is determined according to the configuration
of the master arm through the same process of Eqs. (16)
Fig. 4 Quasi-static change of grasping force.
2570
to (22). Also, the control transitsto the FREE state and
the object is located at a new position and orientation
object to the SGI graphics workstationthrough the
Myrinet local area network (Myrico@ Inc.). On the
workstation, the Alpha_ I OPEN-GL viewer draws the
when the fingertips separate over the threshold in Eq.
(28).
solid model of the master arm and the object as the visual
display to the operator. The transmission and refresh rate
of the visual display is 32Hz, which is fast enough
compared to the scanning rate of the CRT display.
4. Implementation
The haptic display is implemented on the system shown
in Fig. 5 consisting of the Sarcos Dexterous Arm Master,
two single board computers (Motorola 68040 and
PowerPC 604e) and an SGI graphics workstation. The
single board computers hosted on a VME bus
communicate together through shared memory.
On the other hand, previously recorded sounds that
correspond to each transition are replayed when the
control transits to a new state. This audio f~back assists
the operator for recognizing the state transition while
touching, grasping and manipulating the virtual object.
The SarcxMDexterous Arm Master has ten joints, each of
which is equipped with a hydraulic actuator, a
potentiometer for position sensor and load celi for torque
sensor.
5. Experimental results
A model of a cylinder (diameter: O.lm, length: 0.4m,
mass: 2kg) is created as the object in the virtual
environment to be grasped and manipulated. The
parameters for stiffness and damping for contacting and
grasping is set as:
The Motorola 68040 manages the signal I/O and joint
torque control of the master arm. The joint position and
torque measured by sensors are acquired through 12 bit
A/D converters. The acquired sensory data are written to
the shared memory to be read by the PowerPC 604e. The
desired joint torque is written to the shared memory by
the PowerPC 604e, and the servo valves are controlled
through 12 bit D/A converters so that the joint torque is
set to the desired value.
KC=130N/m05,
BC= 100Ns/ml 5
K. =lOOON/mO5, B. ‘800Ns/m] 5
In the FREE state shown in Fig. 6 (a), the operatorcan
freely move the hand and arm while the gravityloading
on the masterarm is compensateduntil the tip of the
index finger or the thumb collides with the virtual
cylinder.
The PowerPC 604e executes the main body of the haptic
display. For both single board computers, the
ControlShell (Real-Time Innovations, Inc.) objectoriented real-time software package that runs on
VxWorks@ (Wind River Systems, Inc.) real-time kernel
and development environment is employed. The
sampling rate of the control is 1920Hz.
In the INDEX CONTACT state as in Fig. 6 (b) and the
THUMB CONTACT state as in Fig. 6 (c), the operator
feels the contact on the cylinder by one fingertip. The
contact is stable without any undesired vibration since
stilcient damping is provided. The operator can easily
recognize the shape of the cylinder by tracing its surface
while receiving the contact force at the fingertip.
The PowerPC 604e transmits the configuration of the
master arm and the position and orientation of the virtual
The control transits to the GRASP state as shown in Fig.
6 (d) when the operator contacts the cylinder with the
tips of both the index finger and the thumb. The steep
increase of the grasping force at the transition (A-+B in
Fig. 4) applies si~lcant
sensation of grasp to the
operator. The operator feels as if the cylinder is
suspended by translational and rotational springs since
the reactive force-moment is applied at the wrist. Also
the operator receives the sensation of squeezing the
cylinder since the grasping force is exerted at the fingers.
fSGI graphics]
MyrinetI ! Shared I
k
As the operator lifts the cylinder, the reaction force
directed downward increases as the cylinder that is
constrained by the stiffness moves upward. When the
reaction force increases to counteract the gravity load of
the cylinder, the control transits to the MANIPULATE
state, This transition applies a mtural sensation to the
VME bus
Fig. 5 Haptic-visual display system.
2571
operatorbecausethe vertical force applied by the master
arm varies continuously.
6.
Conclusion
In this paper, a haptic display for object gmsping and
manipulating is proposed as a fundamental technique for
rapid prototyping in a virtual enviromnent. The haptic
display is implemented on the Sarcos Dexterous Arm
Master and experimentally confirmed to provide a
realistic sensation of grasping and manipulating that
enables the operator to manipulate the virtual object
easily as desired.
The operator can manipulate the cylinder freely in the
MANIPULATE state as shown in Fig. 6 (e) while
feeling both the gravity load of the cylinder at the wrist
and the grasping force at the fingers. The operator can
sense the position of the cylinder’s center of gravity since
the moment is determined according to it. As a result,
when the operator grasps the eccentric part of the
cylinder, it can be recognized and the eccentricity of the
gravity had is sensed to vary while the operator rotates
the grasped cylinder.
After the cylinder is manipulated to a desired position
and orientation the operator can place it there by
releasing the hand as shown in Fig. 6 (9. As a whole, the
operator receives a natural sensation of grasping and
manipulating the cylinder easily as intended.
Ahhough the sounds played for the audio feedback are
not precisely synthesized based on the mechanical model
of contacting, grasping and manipulating, it assists the
operator for recognizing the state transition as well as the
Since the final aim of this research is a realization of
haptic display in a CAD environment, it is important
how realistic is the haptic sensation that the opemtor
receives. Although such a quantitative evaluation from a
psychological viewpoint is not discussed in this paper, it
will be investigated in the future.
In addition to the virtual grasping and manipulating
achieved here, more complicated tasks such as
assembling multiple parts, checking the interference,
confirming the motion of the mechanism and so on
would be required for advanced rapid prototyping. The
realization of a haptic display capable of providing the
sensation of such tasks will be a next target.
(b) INDEX CONTACT
state,
(e) MANIPULATE state.
Fig. 6 Experimental grasping and manipulating of cylinder.
2572
Acknowledgments
Support for this research was provided by NSF Grant
MIP-9420352. The first author visited The University of
Utah while the fellowship program provided by Science
and Technology Ageney, Japan. The authors sincerely
thank Rodney Freier, Don Nelson and Thomas V.
Thompson II, for their contribution in implementing the
haptic-visual-audio display.
References
[1] Agronin, M. L., The Design of a Nine-String Six-
[2]
[3]
[4]
[5]
[6]
[7]
Degree-of-Freedom Force-Feedback Joystick for
Telemanipulation, Proc. of NASA Workshop on
Space Telerobotics, pp. 341-348, 1987.
Bergamasco, M., B. Allots, L. Bosio, L. Ferretti, G.
Parrini, G. M. Prisco, F. Salsedo, and G. Sartini, An
Arm Exoskeleton System for Teleoperation and
Virtual Environments Applications, Proc. of IEEE
Int. Conf on Robotics and Automation, pp. 14491454, 1994.
Brooks, F. P. Jr., M. Ouh-Young, J. J. Batter, and P.
J. Kilpatrick, Project GROPE-Haptic Displays for
Scientific Visualization, Computer Graphics, vol. 24,
no. 4, pp. 177-185, 1990.
Hollerbach, J. M., E. Cohen, W. Thompson, R.
Freier, D. Johnson, A. Nahvi, D. Nelson, T. V.
Thompson II, and S. C. Jacobsen, Haptic Interfacing
for Virtual Prototyping of Mechanical CAD Designs,
Proc. of ASME Design for Manufacturing Symp.,
1997.
Iwata, H., Hlcial
Reality with Force-Feedback:
Development of Desktop Virtual Space with
Compact Master Manipulator, Computer Graphics,
vol. 24, no. 4, pp. 165-170, 1990.
Marhefka, D. W. and D. E. Orin, Simulation of
Contact Using a Nonlinear Damping Model, Proe. of
IEEE Int. Conf. on Robotics and Automation pp.
1662-1668, 1996.
Yoshikawa, T. and H. Ueda, Haptic Virtual Reality:
Display of Operating Feel of Dynamic Virtual
Objects, Proc. of Int. Symp. on Robotics Research, pp.
214-221, 1995.
2573
Download