You are on page 1of 5

Tactile Force Control Feedback in a Parallel Jaw Gripper

Daniel Castrol', Lino Marques*', Urban0 Nunes*' and A.T. de Almeida*'


*ISR - Institute of Systems and Robotics (Coimbra Pole), 3030 Coimbra, Portugal.
UCEH - University of Algarve, Campus de Gambelas, 8000 Faro, Portugal.
' Department of Electrical Engineering, University of Coimbra, Pole 11, 3030 Coimbra, Portugal.

Abstract - Carrying out an autonomous object prehension 11. THE TACTILE SENSOR
task, needs some active interaction with the environment,
which only could be done with sensory integration on the The tactile sensing system developed in the ISR-
robot tools. A study of the contact force control performed Coimbra Pole (Institute of Systems and Robotics) [5,6],is
with tactile feedback in a low cost servo-controlled parallel based on a piezoresistive thick-film polymer manufactured
jaw gripper is presented in this article. This gripper by Interlinkm. The distributed pressure is sensed by a
integrates matricial tactile sensors and proximity sensors.
16x16 matrix of force sensing resistors (FSR) pressure
Considering the nonlinear nature of the control system,
hybrid control strategies were used, inter-relating classical transducer (tactile elements or taxels), providing a spatial
digital control strategies with heuristic rules and logic. Two resolution of 1.54 mm with a sensing area of 6.25 mm2.
control algorithms were studied, and experimentally The FSR elements are polymer film gauges that exhibit
validated in a force-compliant mechanical system: hybrid decreasing electrical resistance with applied normal force.
proportional controller; hybrid proportional integral and The acquisition module combines an analog-digital
derivative controller. scanning circuit and a 16 bits microcontroller (Intel
80C196KC) with an analog-to-digital converter, as shown
I. INTRODUCTION in Fig. 2. The scanning array technique implements a
taxel-isolation technique that consists in a voltage
Object grasp stability depends on two factors: 1)- an feedback of the selected taxel into all other not selected
appropriate prehension force; 2)- correct contact points rows and columns taxels [ 5 ] , with a maximum sampling
location. Usually, the contact force control is in the third rate for the entire matrix of 125 Hz. This module
phase of the grasping process, the postcontact phase, when dimensions are small enough to put them on a robot arm
there is a well defined contact between the robot tool and near the wrist.
the object. In this phase the goal is to get contact stability, The two-layered design of the FSR transducer can give
which means the ability for the end-effector to maintain rise to degradation of the sensor response if the two halves
contact with an object without slipping even when the are allowed to slide one relatively to the other. To cope
object is subjected to disturbing external forces, with this problem we placed a 10 mils thick, low
Several researchers have been studying the force control resistance, sheet of anisotropic elastomeric conductive
in robotic mechanisms namely Mason [l], Mason and polymer interconnect (manufactured by AT&T) between
Salisbury [ 2 ] and Nakamura et al. [3]. Contact force the transducer halves likely Speeter [7]. Covering the FSR
control deals namely the transition problem from position sheet there is a compliant rubber, too.
control (precontact) to force control (postcontact). Recent
work has shown that successful transitions from free 111. CONTACT FORCES MODEL
motion to constrained motion can possibly be addressed by
gain scheduling algorithms, and requires the control of the Only the contact normal force distribution is sensed by
contact forces as soon as contact is made [4]. the tactile sensor. Associating this characteristic, to the
This paper addresses a new approach to tactile force
control provided by the analysis of matricial tactile
information.

A. Article Organisation

A brief description of the tactile sensor is given in


section 11. The forces centre (centroid) processing is
introduced in section 111. In section IV, a modified digital
PID controller and the resultant hybrid PID controller
experimentally used are described. In section V
experimental results are shown. Finally, section VI
contains some concluding remarks and discusses future
work.
Fig. 1. Parallel jaw gripper with tactile and proximity feedback.

IEEE Catalog Number: 97TH8280 -884- ISIE'97 - Guimariies, Portugal


Fig. 3. Force model, in a parallel jaw gripper with a matricial tactile
sensor in each finger. There are three coordinate systems: { S ’ ) associated
to the tactile matrix in the left hand finger, {S”] associated to the tactile
matrix in the right hand finger and (S} associated to the gripper
coordinate system.
Fig. 2. Tactile Sensor Scanning and Acquisition Hardware.

sensor planar geometry, gives a parallel forces system with (less flexible) and the other as Spring I1 (more flexible).
points of application in the sensors plane. These two
conditions leads to the possibility of force centre (centroid) B. Contact Force Control Methodologies
computation and related resultant force.
Let {S’) denote the coordinates system of the tactile Usually all types of motion transmission systems have
sensor in the left hand finger. The centroid c’ described in several nonlinearities. To deal with these nonlinearities,
{ S’ } is given by a point with coordinates: some researchers have been developing new control
strategies, based on nonlinear programming, hybrid
controllers and heuristics [2].Linear optimal control was
used by Akella and Cutkosky [4], considering negligible
nonlinearities, to deal with contact forces.
R’
Considering the nonlinear nature of the control system,
hybrid control strategies were used in this work, inter-
relating classical digital control strategies with heuristic
R‘ rules and logic. Two control algorithms based on a
modified digital PID controller were studied, and
where R’ represents the resultant force, F’ij represents the experimentally validated in a force-compliant mechanical
contact force in each tactile element (ij) and (X’i, z’j) are system: a hybrid proportional controller and a hybrid
the coordinates of each tactile element (i,j). proportional integral and derivative controller.
The resultant force in each matricial subsystem is
perpendicular to the sen:sors plane XY and is the result of C. Mod$ed Digital PID Controller
the algebraic sum of all contact forces in each subsystem.
The resultant force R’ described in ( S ’ } is given by the Some modifications to the standard discrete PID control
following expression: algorithm have been proposed to improve its performance
(see Fig. 4) [8]. In order to reduce large output changes
16 16
R’= CC F‘, 2’ caused by rapid changes in the reference signal, the
reference variable r(k) is not included in the derivative
;=I j L 1
term (B-Block, in Fig. 4). All the integral parameters are
where z‘denotes the unit vector along 2’-axis. Similarly, only present in the integration term (A-Block, in Fig. 4).
we can obtain the centroid c” relative to the right hand This modified algorithm is less sensitive to higher
finger. frequencies of r(k) than to those of fr(k). The controller gi
parameters, are:
IV.CONTACT FORCE CONTROL Kp.TD
A. Experimental Setup
go = - K , - 7 (3)

A parallel jaw gripper was developed for grasping and


(4)
fine manipulation. Its mechanical actuation system consists
of a ball-screw with a right and left threads, and a 2.6:l
gear box. The actuator is a permanent-magnet DC motor
(PMDC).
The force control study was accomplished using only
one gripper finger in c.ontact with a compliant surface. where, KP is the proporcional gain, Ti is the integration
Two different compliant devices were used to study time, To is the derivative time and T, is the sampling time.
different contact force ranges, one referred as Spring I

IEEE Catalog Number: 9mH8280 - 885 - ISIE’97 - GuimarLs, Portugal


Fig. 4.Closed loop system with a modified discrete PID controller. Fig. 6. Developed control system, considering: the driver command
scaling (116) module; the dead-zone transposal module
( u(k) = 3z A + U * ( k ) ); and the actuator management module.
The controller pi parameters are different for both
integration methods in use. For the rectangular integration and the process G(q”)module.
method, The command scaling converts the controller command
T I m u,(k) in a proper command value u*(k) to drive the servo-
amplifier. Next, the command value U * @ ) needs to
transpose the dead-zone threshold. Dead-zone transposal
consists of a simple addition operation (u(k)=+A+u *((k)),
and the controller difference equation is
with the threshold value A=270. Finally, the actuator
r m
management module annuls the actuation command
whenever the output value is in the range of 98% of the
reference value.
(7)
V. EXPERIMENTAL RESULTS

Results of the hybrid proportional controller are shown


For the trapezoidal method, in Figs. 7, S, 9 and 10, for different gain values in some
K p 4 cases with and in other cases without actuator
Po = P i =- management. The dead-zone thresholds are represented in
2. I;
these figures by two dotted lines (values +270). Fig. 7
and the controller difference equation is shows a proportional step response to a test reference value
r(k)=3000, without actuator management. The
proportional gains are Kp=l (continuous line) and
Kp=0.05 (dashed line). Fig. 8 represents the digital control
value u(k) of the proportional controller without actuator
management, shown in Fig. 7. Fig. 9 shows a proportional
step response to a test reference value r(k)=3000, in this
case with actuator management. The proportional gain is
The tuning of the controller parameters was made Kp=0.05 (continuous line), Fig, 10 represents the digital
according to Takahashi PID tuning rules[8]. control values u,(k) (dashed line) and u(k) (continuous
line), of the proportional controller with actuator
D. Hybrid PID Controller management, for the test condition of Fig. 9. As can be
seen in Fig. 10, the digital control value u,(k) needs to be
The gripper (mechanical structure and PMDC motor) is scaled to a new value u*(k)=(1/6).uc(k),and the dead-zone
a nonlinear system. A dead-zone and an actuator saturation
transposal is accomplished by the operation
are the most significant nonlinearities. The gripper could
u(k)=+270+u *(k). In this particular test, the actuator
be represented by the nonlinear function of Fig. 5 .
management provides to the control system an excellent
The developed hybrid control system, shown in Fig. 6 ,
output response, as can be seen in Fig, 9.
is composed by five modules: the digital PID controller
Results of the hybrid PID controller are shown in Figs,
G,(q-’) module; the command scaling module; the dead-
11 and 12 for different integration methods (rectangular
zone transposal module; the actuator management module;
and trapezoidal). Fig. 11 shows a PID step response to a
I test reference value r(k)=3000, with actuator management,
I
I f, + for the trapezoidal (continuous line) and rectangular
(dotted line) integration methods. Fig. 12 represents the
digital control values u,(k) of the trapezoidal integration
(continuous line) and the rectangular integration (dotted
Saturation line), to the test conditions of Fig. 11. This test includes a
*- , -
I transition from precontact to postcontact. The initial
distance between the fingertip and the compliant test
Fig. 5. Actuator system nonlinearities.
system is 3 mm. The Spring I1 compliant device was used.

WEE Catalog Number: 97TH8280 - 886 - ISIE’97 - GuimarZies, Portugal


.-.Kp=l

hj
' -0
0 10 20 30 40 50 , 70 80 90 100 0 IO 20 30 40 50 60 70 80 90 100

N.SAMPLES (Ts=32msl N SAMPLES (Tsx32ms)

Fig. 7. Proportional step response to a test reference value r(k)=3000, Fig. 8. Digital control values u(k) from a proportional controller without
without actuator management. The proportional gains are Kp=l (-) and actuator management. The reference value is r(k)=3000. The proportional
Kp=0.05 (---). gains ace Kp=l L) and Kp=0.05 (-).

-400 I I
0 10 20 30 40 50 60 70 80 YO 100

N.SAMPLES (Ts32ms) N SAMPLES (Ts=32ms)

Fig. 9. Proportional step reslponse to a test reference value r(k)-3000, Fig. 10. Digital control values u,(k) (---I and ufk) (-), from a
with actuator management. The proportional gain is Kp=0.05. proportianal controller with actuator management. The reference value is
The actuator management uses a 98% criterion to the final value. r(k)=3000. The proportional gain is Kp=0.05.

0 10 20 30
-40 50 60 70 80 90 100
.3"
0 10 20 30 40 50 60 70 80 YO
J
100
EL SAMPLES (Ts=32ms) N.SAMPLES (Ts=32ms)

Fig. 11. PID step response with trapezoidal integration (-) and Fig. 12. Digital control values u,(kj, for trapezoidal integration (-) and
rectangular integration (...), ita a reference value r(k)=3000. The initial rectangular integration (...), to the test conditions of Figure 11.
distance between the fingertip and the compliant test system is 3 mm.

IEEE Catalog Number: 9LllU8280 -887- ISIE'W - GuimarSes, Portugal


The best results were achieved with the trapezoidal [3] Y. Nakamura, K. Nagai and T. Yoshikawa, ”Dynamics
integration method. and Stability in Coordination of Multiple Robotic
Mechanisms”, International Journal of Robotics
VI. CONCLUSIONS AND FUTURE WORK Research, vo1.8, no.2,April 1989, pp.44-61.
[4] P. N. Akella and M. R. Cutkosky, ”Contact Transition
A force controlled gripper was described using tactile Control with Semiactive Soft Fingertips“, IEEE
sensing in fingertips. Trans. on Robotics and Automation, vol. 11, no. 6,
The tactile sensor provides good qualitative information. 1995, pp.859-867.
Similar to human tactile system, a good contact perception, [ 5 ] U. Nunes, D. Castro, L. Silva and A.T. de Almeida,
doesn’t require an absolute force value knowledge. “Sensor de Tacto Matricial Piezoresistivo para
To increase the gripper fingertips compliance besides AplicaGBes em Robbtica”, in Proceedings of the 3as
the rubber compliant cover, some passive compliance must Jornadas Hispano-Lusas de Ingenieria Electrica,
be inserted on the fingertips. 1993, pp.1735-1744, (in Portuguese).
The next step is the integration of this gripper in a [6] D. Castro, L. Marques, U. Nunes and A.T. de Almeida,
teleoperated robotic sensory system for remote grasping “Preens50 com Recurso a InformaS5o de Tacto e
and fine manipulation. A virtual environment of the Proximidade para Tarefas de Manuseamento com
remote station, integrating tactile information, proximity Incerteza Posicional”, in Proceedings of the 4as
information, vision and force-torque control, was already Jornadas Luso-Espanholas de Engenharia
developed in the ISR [9] to remotely control a PUMA Electrothica, 1995, pp. 1585-1592, (in Portuguese).
robot manipulator. [7] T.H. Speeter, “A Tactile Sensing System For Robotic
Manipulation”, International Journal of Robotics
VII. REFERENCES Research, vol. 9, no. 6, 1990, pp.25-36.
[81 R. Isermann, Digital Control Systems, Springer-Verlag,
[l] M.T. Mason, “Compliance and Force Control for 1981.
Computer Controlled Manipulators”, IEEE Trans. on [9] R. CortesIo, R. Arafijo, U. Nunes and A.T. de
Systems, Man, and Cybernetics, vol. 11, 1981, Almeida, “Modeling and Communicating in
pp.418-432. Teleoperation Environments”, in Preprints of the 4th
[2] M.T. Mason and J.K. Salisbury Jr, Robot Hands and IFAC Workshop on Algorithms and Architectures for
the Mechanics of Manipulation, MIT Press, 1985. Real-Time Control (AARTC‘971, 1997, pp. 199-204.

IEEE Catalog Number: 97TH8280 -888- ISIE’97 - Guimariies, Portugal

You might also like