Closed-Form Force Sensing of A 6-Axis Force Transducer
Closed-Form Force Sensing of A 6-Axis Force Transducer
Abstract
The 6-axis force transducers based on the Stewart platform require the solution of forward kinematics of the Stewart platform in order to
obtain force and torque acting on the upper plate from given six leg forces. However, the solution of forward kinematics is not known in a
closed form. In this paper, a closed-form solution of the forward kinematics is derived by means of linearization of the inverse kinematics
equations, and the derived solution is applied to the calculation of force and torque acting on the transducer. In order to investigate the
validity of the proposed method, a prototype of the transducer based on the Stewart platform is developed and force analysis is conducted.
Moreover, the gravity compensation algorithm is proposed to reduce the weight effects of the transducer. # 2001 Elsevier Science B.V. All
rights reserved.
0924-4247/01/$ ± see front matter # 2001 Elsevier Science B.V. All rights reserved.
PII: S 0 9 2 4 - 4 2 4 7 ( 0 0 ) 0 0 5 6 4 - 1
32 C.-G. Kang / Sensors and Actuators A 90 (2001) 31±37
The paper is organized as follows. Section 2 presents the sents a rotation of a about xA-axis followed by a rotation b
inverse and forward kinematics problems, Jacobian, and about yA-axis followed by a rotation g about zA-axis. The
force relationship of the Stewart platform, and then derives equation obtaining l from the given x can be expressed as
a closed-form solution of 6-axis force transducer that solves
l g
x (1)
the forward kinematics of the Stewart platform by means of
a linearization technique. In Section 3, the kinematic struc- and this equation is known as `inverse kinematics' of the
ture of the Stewart platform being used as a force transducer Stewart platform. Note that the bold face in this paper
is designed in terms of radii of the upper and lower plates, represents vector quantity. To express the inverse kinematics
length of six legs, and distance of joints. Section 4 presents (Eq. (1)) more specifically, we define A ai as the position
numerical error evaluation by the proposed linearization vector of Ai with respect to frame {A}, B bi as the position
technique. Section 5 shows the results of experimental vector of Bi with respect to frame {B}, A d
xc ; yc ; zc T as
works, and Section 6 concludes. the position vector of the origin of the frame {B} with
respect to frame {A}, and AB R as the rotation matrix trans-
forming the coordinates with respect to {B} to the coordi-
2. Closed-form solution of forward kinematics of the nates with respect to {A}. Then the inverse kinematics
Stewart platform via linearization solution of the Stewart platform can be written as
q
The Stewart platform being used as the 6-axis force li lTi li ; li AB RB bi A d ÿ A ai i 1; . . .; 6
transducer is composed of an upper plate, a lower plate,
and six instrumented elastic legs connecting the two plates where li is the vector representing the length and direction of
with appropriate joints. The kinematic structure of the leg i with respect to frame {A}. In the above equation, A ai
Stewart platform is shown in Fig. 1. The coordinate frame and B bi are constant vectors, and AB R is varying with rotation
{A} and {B} in Fig. 1 are attached to the centers of the lower angles a, b, g.
and the upper plates. The `forward kinematics' of the Stewart platform is the
In order for the upper plate to have a six controllable problem obtaining the position and orientation x of the upper
degrees of freedom motion, one joint at the end of the elastic plate from the given leg length l. The closed-form solution of
leg must be a spherical joint (e.g. ball and socket joint) and the forward kinematics for the general Stewart platform is
the other joint of the leg be a universal or spherical joint [10]. not known although many researchers have tried to solve it
The Stewart platform may have some singularities related to [12,13]. Therefore, a numerical solution (e.g. Newton±
the architecture of it. To prevent these architecture singula- Raphson method) used to be applied to the place where
rities, we should design the kinematic parameters of the the solution of forward kinematics is needed [9]. In general,
Stewart platform so that the upper and the lower plates may however, numerical solution is not recommended in real-
not be regular hexagons, and the longer side of one hexagon time application because of convergence speed and timing
may be connected to the shorter side of the other hexagon limitation.
with legs if the two plates are similar [11]. In this paper, a closed-form solution for forward kine-
Let l
l1 ; . . . ; l6 T be a vector representing lengths of matics is obtained approximately and applied to the 6-axis
six legs, and x
x; yc ; zc ; a; b; gT be a vector representing force transducer. For this purpose, differentiating Eq. (1)
the position and the orientation of the upper plate. The with respect to time results in relationship between leg
xc ; yc ; zc T in x represents the coordinates of the origin of velocity and velocity of the upper plate such as
frame {B} with respect to frame {A}, and
a; b; gT repre- l_ J
xx_ (2)
where J
x @g=@x, and J(x) is called the `Jacobian' of the
Stewart platform.
Note that static relationship between force/torque acting
on the upper plate and leg forces is obtained from the
principle of virtual work as follows.
F J T
xf (3)
T
where f
f1 ; . . .; f6 is the vector representing magnitudes
of six leg forces, and F
Fx ; Fy ; Fz ; Mx ; My ; Mz T is the
vector representing force and the moment (torque) acting on
the center of the upper plate.
The static forces in the transducer are analyzed on the
assumption that leg de¯ections are small (this is true for
Fig. 1. Kinematic structure of the Stewart platform and coordinate frame transducers) and the effect of dynamic forces are negligible.
assignments. In Eq. (3), the Jacobian J(x) is a function of the position and
C.-G. Kang / Sensors and Actuators A 90 (2001) 31±37 33
orientation of the upper plate. Therefore, we have to know To investigate the isotropy of the forces F acting on the
the position and orientation of the upper plate to obtain the upper plate, let us consider the case that the upper plate can
force/torque F acting on the upper plate from the given leg exert forces F without generating any rotational motion from
forces f. In other words, we have to solve the forward the leg forces satisfying
kinematics problem.
jf j 1 (5)
In this section, the solution of forward kinematics of the
Stewart platform is obtained from the solution of the inverse The evaluation of the forces F for this case (i.e. the
kinematics using ®rst-order approximation (i.e. lineariza- mapping of Eq. (5) with F JfT f satisfying JmT f 0) results
tion), and is used for the 6-axis force transducer on the in the following inequality.
assumption that there are no singularities within the work-
space of the transducer. For the linearization of the inverse F T QF 1 (6)
kinematics solution (1), let a normal operating condition x0, 33
where Q
2 R is a symmetric matrix derived from Jf and
l0 to be Jm. This inequality forms an ellipsoid. Now we calculate the
x0
0; 0; z0 ; 0; 0; 0; l0 g
x0 ratio of the minor axis to the major axis of the ellipsoid
(Eq. (6)), i.e.
where z0 is the height of the upper plate when the spring is
the minor axis
neither stretched nor compressed. The linearized inverse sf
kinematics is given by the major axis
Table 1
Obtained force/torque F when the upper plate is maximally displaced only in the yA direction
Table 2
Maximum errors in F when the upper plate has maximum linear and angular displacements in xA, yA, zA directions (0.43% leg deviations)
moment measuremnets, if 0.43% leg deviation is allowed, moment (i.e. couples) on the transducer is generated by
and 0.03% maximum error, if 2% leg deviation is allowed using a pulley and string mechanism.
with the selected design parameters. Actually, these errors We de®ne the clockwise rotation of the transducer in a
are within noise levels come from sensor electronics and horizontal plane of the experimental set-up to be a yaw
environmental changes. This fact shows the validity of the motion, and the rotation of the transducer about the axis of
proposed method using linear transformation matrix instead the encoder to be a pitch motion. In order to evaluate the
of using numerical solutions of nonlinear equations. effect of the weight of the transducer on measurement,
forces and moments in case that any external forces and
torques are not applied, are measured at every 458 in yaw
5. Experimental results direction and at every 68 in pitch direction, and then a look-
up table is constructed from these measurement data. Fig. 5
In order to investigate the validity of the proposed method, shows one example of the measurement results.
a prototype of the transducer based on the Stewart platform Since the gravity effect of the transducer weight on force
is developed, which is shown in Fig. 3. Each leg is composed and torque measurements is expectable if the position and
of two springs (one for compression, and one for extension), orientation of the transducer is known in advance, it can be
LVDT and core. It can measure up to 5 kgf (1 VDC/1 kgf) compensated by using the look-up table generated above and
and can deviate 0.57 mm maximally. The six legs and linearly interpolating it. Fig. 6 shows the measurement result
upper and lower plates are connected using ball and socket after gravity compensation in the pitch direction.
joints and joint adapters. The upper and lower plates and When 40 N force is applied to the center of the upper plate
joint adapters are made from Al 7075 and Al 2024, respec- of the transducer to evaluate the gravity compensation for
tively, in order to reduce weights. transducer weight, the difference of the true and measured
Fig. 4 shows the schematics of the experimental set- data is within 2.6% in force measurements and within 0.54%
up. The encoder and counter board in the ®gure are for in torque measurements. Thus, the gravity effect due to the
the measurement of the angle of the transducer. If net transducer weight is compensated effectively.
external force and torque acting on the upper plate is Next, the experiments on force measurements are con-
required, the gravity effect of the upper plate should be ducted for arbitrary forces and moments with arbitrary
compensated from the known position and orientation of the magnitudes and directions. Linearly measurable ranges of
lower plate and the known weight of the upper plate. For this forces and moments of the transducer is determined by
purpose, gravity effect is measured at each rotated angle of measuring forces and moments with increasing external
the transducer and compensated by using the measurement forces and moments in each direction until saturations
data and an interpolation algorithm. Externally applied pure occur.
Fig. 5. Force and torque generated by the weight of the transducer (in case
Fig. 4. The schematic diagram of the experimental set-up. yaw 0 ).
36 C.-G. Kang / Sensors and Actuators A 90 (2001) 31±37
Table 3
The ranges of force and torque measurements
6. Conclusion
Acknowledgements