Professional Documents
Culture Documents
Abstract— This work proposes a mechatronic solution to to solve kinematic redundancy and to implement strategies
increase the back-drivability of a state-of-the art robot for wrist for motor efficiency [8].
neurorehabilitation. The final goal is to reduce robot mechanical The first historical examples (1847) of such intrinsic con-
impedance in order to cope with intrinsic kinematic constraints,
which are adopted by the human brain to solve redundancy straints were found in the oculomotor system by Donders. He
during pointing tasks with the wrist. The handle of the robot found that, for a given steady gaze direction, physiological
has been provided with a load cell and a direct force control eye configurations are described by a 2-dimensional surface
scheme has been implemented to minimize the interaction embedded into the 3-dimensional space of eye configurations
forces/torques between the user and the robot. To this aim (Donders’ law) [9]. Nowadays, it has been demonstrated that
gravity, inertia and friction of the more proximal DOF of the
robot (relative to Pronation/Supination (PS) movements) have such a law is actively implemented by a neural mechanism,
been estimated and compensated for. The proposed solution and it is also well applied to limb movements [8], [10].
resulted in a 70% reduction of the end-point perceived inertia Recent studies demonstrated that Donders’ law applies
in PS DOF as well as in a decrease of torques exerted by the user also to wrist movements during pointing tasks (in which
during both 1-DOF and 3-DOFs tasks. The average reduction of the three DOFs of the wrist are redundant) [11]. This
interaction torques is around 81% and 78% respectively. This
work constitutes an important starting point for the analysis of study was conducted measuring wrist orientations during
the effect that different levels of robot transparency could have pointing movements using a lightweight ‘hand-held device’,
on the human neural constraints adopted during redundant which introduces negligible perturbation to the physiological
tasks, such as pointing movements with the wrist. movements. The three dimensional rotations vectors resulted
well fitted by quadratic (Donders’) surfaces, whose curvature
I. INTRODUCTION
expresses inter-subjects differences in motor strategies, thus
Rehabilitation robotics has become an emerging field in denoting a ‘personal style’ in solving redundancy [11].
recent years and the potentialities of robot-mediated motor The same analysis was conducted in [12] with subjects
therapy is being widely investigated [1]–[4]. performing similar pointing tasks while interacting with the
During traditional neurorehabilitation sessions the role of InMotion3 system (Interactive Motion Technologies, Inc.),
the patient is quite passive and the participation of the a the state-of-the-art robot for wrist neurorehabilitation,
high-level structures of his nervous system are limited. On specifically designed to comply with the biomechanical con-
the other hand, robotic therapy allows subjects to perform straints, and providing a high degree of back-drivability [13].
voluntary movements, thus promoting neurogenesis and neu- In this case no statistically significant difference was found
roplasticity, and optimizing the functional recovery after between subjects, suggesting that the robot flattens out any
neurological injuries [5], [6]. personal intrinsic motor strategy (in particular the most prox-
Rehabilitation robots have to provide assistance as needed, imal joint, for pronation/supination movements, is perceived
so that to not perturb voluntary movements of the users, as too heavy by the subjects during the task). In other terms,
and to help completing the tasks that they are not able to the robot perturbs voluntary movements of the subjects,
perform autonomously. In this sense a high back-drivability, despite its low mechanical impedance (it has been shown
i.e. a low perceived impedance during retrograde motion, to not be transparent enough to comply with the intrinsic
is of crucial importance. The technological choices in the constraints of neural origin).
design of mechanical structure and control strategies of The goal of this work is to provide the handle of the
robots strictly interacting with humans, have to face several InMotion3 wrist robot with a load cell and to implement
issues, such as safety, dynamical adaptability and biome- a direct force control scheme to improve the back-drivability
chanical compatibility [7]. Moreover, it has been shown that of the system. This kind of mechatronic approach has been
rehabilitation machines have to comply not only with ‘hard’ already validated in [14] on the MIT-MANUS robot [1]
(biomechanical) constraints but also with ‘soft’ (instrinsic) (InMotion2 system by Interactive Motion Technologies, Inc.)
constraints of neural origin, which are adopted by the brain in both simulation and experimental tests. In [14] a reduc-
tion of (mean and maximum) forces exerted by a subject
N. L. Tagliamonte, D. Formica, M. Scorcia and E. Guglielmelli are
with the Laboratory of Biomedical Robotics and Biomicrosystems, Faculty during planar pointing tasks has been verified in different
of Biomedical Engineering, Università Campus Bio-Medico di Roma, Via operative conditions, demontrating the effectiveness of the
Álvaro del Portillo, 21 - 00128 Roma, Italy. chosen force control algorithm in improving the system
D. Campolo is with the School of Mechanical & Aerospace Engineering,
Nanyang Technological University, 50 Nanyang Avenue, Singapore. transparency. In this work the handle of the InMotion3 wrist
Corresponding author: n.tagliamonte@unicampus.it robot has been sensorized; inertia, friction and gravitational
4385
ze ye
T
J xe
Fsens t1
Fd t3 !
-
JT KP ˆ + y0 ! y1
B Robot ! z0 z1
+ + +
! q, q˙ x0 z2 y2 !x1
!
! ! !x 2
! !
! ! bˆ q˙ + gˆ (q ) ! !
! ! !
! !t
2
! !
Fig. 3. Block diagram of force control
! scheme in (2); the ‘Robot’ block
represents the first term of equation (1).
!
Fig. 4. Schematic representation of the robot kinematics (without the pas-
sive DOFs); frames of reference are selected using the Denavit-Hartenberg
convention. We measured a = 0.062 m, b = 0.158 m, c = 0.022 m,
increasing proportional gain (within stability margins) will d = 0.120 m, l = 0.100 m.
reduce the end-point perceived inertia. Force control in (2)
has been implemented only for the PS DOF since the AA and
FE DOFs are already highly back-drivable (their mechanical position control), thus neglecting the contribution of changes
impedance is one order of magnitude smaller than the one in AA and FE configurations on the PS gravity term.
of PS DOF [13]); for this reason the control torques can be The robot was commanded to reach 10 positions (from
written as follows: -0.6 rad to +0.6 rad with respect to its rest position); PS
actuator torques exerted to maintain these rotations in static
τP S = τ [1 0 0]
T conditions were evaluated. Figure 5 shows an example of the
PS torque and angle patterns during one estimation test of
τAA = 0 (4)
gravity term.
τF E = 0
A linear regression between PS torque and the sin of the
with PS rotation was calculated. In Fig. 6 the collected data (static
PS angles and torques for the 5 trials) are shown together
τP S = bP S q̇P S + τPg S + with the best fitting curve.
+ [J T (q)F sens + B̂(q)K P J T (q)(F d − F sens )][1 0 0]T The slope of the linear curve in Fig. 6, averaged on the
(5) 5 trials, was found to be gP S = 2.254 ± 0.009 Nm, with a
mean R2 of 0.980.
where τPg S = gP S sin(qP S ) and bP S are the gravity term
and the friction coefficient of the PS DOF, respectively. C. Inertia and friction estimation
The implementation of the control scheme in (5) required To estimate inertia and friction terms the robot was back-
the calculation of the robot kinematic operators and the driven by one of the authors to perform few rapid oscillating
estimation of its dynamical properties. movements. The PS motor compensated the gravity effect
(on the basis of the estimation reported in III-B) and the AA
A. Robot kinematic operators and FE actuators were commanded to maintain their rest
Since the robot native control is implemented only in the positions through high gains PD control; in these conditions
joints space, the calculation of the Jacobian matrix J (q), forces/torques exerted on the hand effector were recorded
and of its transpose J T (q), was necessary to map the and their effect on the PS DOF was calculated as follows:
forces/torques measured in the operative space in the corre-
sponding actions on the joints. A schematic representation of PS
τsens = [J (q)T Adg F ssens ][1 0 0]T . (6)
the robot kinematics (without considering the passive DOFs)
is provided in Fig. 4. Denavit-Hartenberg convention was
used to select the frames of reference.
0.6 1.5
In addition the adjoint transformation [17] was used to
map the vector of generalized forces from the sensor coor- 0.4 1
dinate frame to the global reference system (base frame): 0.2 0.5
oPS [Nm]
0 0
reference frame, see Fig. 4).
ï0.2 ï0.5
To estimate the gravity term for the PS DOF, a correla- ï0.6 ï1.5
tion between different static configurations and the torques 0 50 100 150 200 250
Time [s]
required to hold the robot in those positions was performed.
It is important to note that tests were carried out with Fig. 5. PS torque and angle patterns during one test for the gravity term
AA and FE DOFs locked (being the actuators commanded estimation. Commanded angles varied from -0.6 rad to +0.6 rad with respect
to maintain their 0 reference position through high gains PD to the robot rest configuration.
4386
15 150
Trial 1
1 Trial 2 10 100
Trial 3
0.5 Trial 4
q̈ P S [rad/s 2 ]
5 50
q̇ P S [rad/s]
oPS [Nm]
Trial 5
0 Linear regression
0 0
ï0.5 ï5 ï50
ï1 ï10 ï100
Fig. 6. Linear regression between τP S and sin(qP S ) static values for Fig. 9. Velocity and acceleration profiles for one representative trial of the
the estimation of the PS gravity term. The fitting curve slope is mediated mechanical impedance evaluation test with force control active on PS DOF.
on 5 trials. The resultant gravitational term is τPg S = gP S sin(qP S ) = These values are obtained by manually back-driving the handle of the robot
2.254 sin(qP S ). while locking AA and FE DOFs.
10 100
q̈ [rad/s 2 ]
0 0 In this section the effectiveness of the force control in (5)
in improving the transparency of the robot is tested. First,
ï5 ï50 the reduction of the end-point mechanical impedance in the
PS DOF, due to the action of the force control has been
ï10 ï100
0 0.5 1 1.5
Time [s]
2 2.5 3 estimated; then the reduction of forces/torques exerted by
three subjects while performing two kinds of pointing tasks
Fig. 7. Velocity and acceleration profiles for one representative trial of the were analyzed, comparing the cases of uncontrolled robot,
inertia and friction identification procedure. These values are obtained by
manually back-driving the handle of the robot while locking AA and FE gravity-compensated robot, and force-controlled robot.
DOFs and compensating the gravity effect for the PS DOF.
A. Reduction of end-point inertia
To evaluate the perceived mechanical impedance with the
In Fig. 7 velocity and acceleration profiles for one repre-
action of the force control, the same procedure described
sentative trial are shown.
in section III-C was followed. In particular the proportional
We estimated the inertia and friction terms for the PS
PS gain of the force control was set to 250 kg−1 m−2 .
DOF by regressing the τsens reported in (6) with angular
velocities and accelerations of the PS DOF, as reported in In Fig. 9 velocity and acceleration profiles for one trial
the following: are shown.
The multivariable linear regression reported in (7) was
PS
τsens = τP0 S + bP S q̇P S + BP S q̈P S (7) calculated on 5 trials; the best fitting plane is shown in
Fig. 10. We found τP0 S = −0.059 ± 0.043 Nm, bP S =
The multivariable linear regression reported in (7) was
−0.002±0.002 Nm·s/rad and BP S = 0.0037±0.0001 kg·m2
calculated on 5 trials; the best fitting plane is shown in Fig.
with a mean R2 of 0.980. The negative value of friction
8. We found τP0 S = 0.219 ± 0.049 Nm, bP S = 0.055 ± 0.005
suggest that an overestimation of this parameter was made.
Nm·s/rad and BP S = 0.012 ± 0.001 kg·m2 with a mean R2
of 0.942.
Trial 1
Trial 2
Trial 1 Trial 3
Trial 2 Trial 4
Trial 5
Trial 3
Fitting plane
2 Trial 4
Trial 5 1
Fitting plane
1 0.5
[Nm]
[Nm]
0 20
0
τ sens
τ sens
PS
PS
10
ï0.5
ï1 0
10 ï1 q̇ P S [rad / s]
ï10
ï150 ï100
ï2 0 ï50 0
ï100 50 100 ï20
ï50 150 200
0 q̇ P S [rad / s] q̈ P S [rad / s 2 ]
50 100 ï10
q̈ P S [rad / s 2 ]
4387
1
1.4
Sub1 ï Peak torque
Sub2 ï Peak torque
1.2
Sub3 ï Peak torque
0.5 Sub1 ï Mean torque
1
[Nm]
[Nm]
Sub3 ï Mean torque
0 0.8
τ sens
PS
τ sens
PS
ï0.5 0.6
0.4
ï1
KP=150 KP=200 KP=150 KP=300 Gravity compensation Motors off
0.2
0 2 4 6 8 10 12 14 16 18 20
Time [s] 0
MO GC FC1 FC2 FC3 FC4
Trial
P S pattern for 1-DOF (PS) tasks, performed by one represen-
Fig. 11. τsens
tative subject, in three different conditions: uncontrolled robot (motors off), P S peak and mean values for 1-DOF (PS) tasks on three
Fig. 12. τsens
gravity-compensated robot and force-controlled robot with different values subjects (Sub1-3). Five conditions are reported: Motors Off (MO); Gravity
of KP . Compensation (GC); Force Control KP = 150 kg−1 m−2 (FC1); Force
Control KP = 200 kg−1 m−2 (FC2); Force Control KP = 250 kg−1 m−2
(FC3); Force Control KP = 300 kg−1 m−2 (FC4).
Anyway, this value can be considered negligible since it was
found to be not statistically different from 0. 1
Of note, the implemented force control causes a reduction
0.5
of the inertia of about 70% with respect to the case with
[Nm]
simple gravity compensation (section III-B). 0
τ sens
PS
ï0.5
B. Reduction of forces/torques exerted by the user
PS
In this section PS torques (τsens , as in (6)) exerted ï1
KP=150 KP=200 KP=150 KP=300 Gravity compensation Motors off
4388
Sub1 ï Peak torque
transparency. Our future works will be focused on demon-
Sub2 ï Peak torque
Sub3 ï Peak torque
strating that Doders’ surfaces, fitting wrist rotations during
1
Sub1 ï Mean torque
Sub2 ï Mean torque
pointing tasks with the robot, will approximate, and ideally
0.8 Sub3 ï Mean torque match, the ones obtained in free space.
[Nm]
0.4 This work was partly funded by the FP7 FET Proactive
Initiative ‘Embodied Intelligence’, project no. ICT-2007.8.5-
0.2 231451 - EVRYON and by the FP7-ICT project, no. ICT-
0
2007.3.2-231722 - IM-CLeVeR.
MO GC FC1 FC2 FC3 FC4
Trial
R EFERENCES
Fig. 14. PS
τsens
peak and mean values for 3-DOFs tasks on three [1] H. I. Krebs, N. Hogan, M. L. Aisen, B.T. Volpe, “Robot-aided neu-
subjects (Sub1-3). Five conditions are reported: Motors Off (MO); Gravity rorehabilitation”, IEEE Transactions on Rehabilitation Engineering, 6,
Compensation (GC); Force Control KP = 150 kg−1 m−2 (FC1); Force pp. 75–87, 1998.
Control KP = 200 kg−1 m−2 (FC2); Force Control KP = 250 kg−1 m−2 [2] C. G. Burgar, P. S. Lum, P. C. Shor, and H. F. M. Van der Loos,
(FC3); Force Control KP = 300 kg−1 m−2 (FC4). “Development of robots for rehabilitation therapy: The Palo devel-
opment of robots for rehabilitation therapy: The Palo Alto Stanford
TABLE I experience, Journal of rehabilitation research and development, vol.
P S PEAK AND MEAN VALUES FOR 1-DOF (PS) AND 3-DOF S TASKS
τsens 37(6), pp. 663–673, 2000.
[3] P. S. Lum, D. J. Reinkensmeyer, R. Mahoney, W. Z. Rymer, and
C. G. Burgar, “Robotic devices for movement therapy after stroke:
Peak torque [Nm] Mean torque [Nm] Current status and challenges to clinical acceptance, Topics in stroke
PS 3-DOFs PS 3-DOFs rehabilitation, vol. 8(4), pp. 40–53, 2002.
MO 1.306 ± 0.055 0.553 ± 0.441 0.427 ± 0.071 0.167 ± 0.131
[4] G. Colombo, R. Riener, and L. Lünenburger, “Human-centered
robotics applied to gait training and assessment, Journal of rehabili-
GC 0.598 ± 0.099 0.522 ± 0.198 0.230 ± 0.038 0.158 ± 0.062
tation research and development, vol. 43(5), pp. 679–694, 2006.
FC1 0.206 ± 0.059 0.155 ± 0.009 0.072 ± 0.012 0.056 ± 0.004
[5] J. D. Schaechter, “Motor rehabilitation and brain plasticity after
FC2 0.181 ± 0.048 0.151 ± 0.185 0.061 ± 0.017 0.049 ± 0.004
hemiparetic stroke”, Prog. Neurobiol., 73(1), pp. 61–72, 2004.
FC3 0.162 ± 0.028 0.139 ± 0.021 0.057 ± 0.007 0.043 ± 0.004
[6] R. Teasell, N. A. Bayona, J. Bitensky, “Plasticity and reorganization
FC4 0.135 ± 0.024 0.108 ± 0.014 0.081 ± 0.066 0.037 ± 0.002
of the brain post stroke”, Topics in Stroke Rehabilitation, 12(3), pp.
11–26, 2005.
[7] D. Reinkensmeyer, N. Hogan, H. I. Krebs, S. L. Lehman, P. S.
Lum, “Rehabilitators, robots and guides: new tools for neurological
implemented to minimize the perturbations in the user natural rehabilitation”, In: Biomechanics and Neural Control of Posture and
Movement, Eds. J. Winters, P. E. Crago, Springer-Verlag, pp. 516–534,
movements of the pronation/supination DOF. 2000.
Dynamical parameters of the PS DOF were estimated and [8] D. G. Liebermann, A. Biess, J. Friedman C. C. A. M. Gielen, T.
compensated for in the control law. Inertia and friction were Flash, “Intrinsic joint kinematic planning. I: Reassessing the Listing’s
law constraint in the control of three-dimensional arm movements”,
identified correlating the torque exerted to back-drive the Exp. Brain. Res., 171, pp. 139–154, 2006.
robot and the velocity/acceleration produced; the gravity term [9] D. Tweed and T. Vilis, “Geometric Relations of Eye Position and
was estimated on the basis of the torques exerted by the robot Velocity Vectors during Saccades”,vision Res., 30(1), pp. 111–127,
1990.
to maintain a set of static configurations. [10] M. Fetter, T. Haslwanter, H. Misslich, D. Tweed, “Threedimensional
We showed that the implemented force control law caused Kinematics of the Eye, Head and Limb Movements”, Amsterdam, The
a net increasing of the robot transparency. The PS iner- Netherlands, Harwood Academic Publisher, 1997.
[11] D. Campolo, D. Formica, E. Guglielmelli, F. Keller, “Kinematic
tial effect was reduced of about 70% and friction became analysis of the human wrist during pointing tasks”, Experimental Brain
negligible (considering a fixed exemplification value of the Research, 2009.
control gain). Gravity compensation lowered the mean PS [12] D. Campolo, D. Accoto, D. Formica, E. Guglielmelli, “Intrinsic con-
straints of neural origin: Assessment and application to rehabilitation
torque required to a healthy subject to perform 1- and 3- robotics”, IEEE Transaction on Robotics, 25, pp. 492–501, 2009.
DOFs tasks of less than 40%. The effect of the force control [13] H. I. Krebs, B. T. Volpe, D. Williams, J. Celestino, S. K. Charles, D.
was to minimize the mean torque exerted by the subject till Lynch and N. Hogan, “Robot-aided neurorehabilitation: a robot for
wrist rehabilitation”, IEEE Transactions on Rehabilitation Engineer-
the 90% and 80% (respectively for 1- and 3-DOFs tasks) of ing, 15, pp. 327–335, 2007.
the value needed in the case of uncontrolled robot. [14] N. L. Tagliamonte, D. Formica, D. Campolo, E. Guglielmelli, “Coping
Results show that an increased level of back-drivability with Intrinsic Constraints of Neural Origin in the Design of Rehabilita-
tion Robots: a Preliminary Study, IEEE/EMBS Conference on Neural
was obtained with the proposed solution. Engineering, Antalya, Turkey, 2009, pp. 124-127.
[15] O. Khatib, “Inertial properties in robotics manipulation: an object-
B. Future Works level framework”, International Journal of Robotics Research, 14, pp.
In [12] it was demonstrated that the InMotion3 system 19–36, 1995.
[16] R. Volpe, P. Khosla, “A theoretical and experimental investigation of
was note able to cope with intrinsic (‘soft’) constraints of explicit force control strategies for manipulators”, IEEE Trans. Autom.
neural origin, used by the brain to solve redundancy during Control, 38(11), pp. 1634–1650, 1993.
pointing tasks with the wrist. Starting from the results of [17] R. M. Murray, Z. Li, and S. S. Sastry, “A Mathematical Introduction
to Robotic Manipulation”, Boca Raton, FL: CRC Press, 1994.
this work it will be possible to verify if the force-controlled
robot is capable to respect the human physiological motor
strategies and which can be the effects of different levels of
4389