Sie sind auf Seite 1von 6

Proceedings of the 1996 IEEE

International Conference on Robotics and Automation


Minneapolis, Minnesota - April 1996

Parameter Estimaition and Actuator 'Friction Analysis


for a Mini Excavator

S . Tafazoli, P.D. Lawrence, S.E. Salcudean, D. Chan, S . Bachmann and C.W. de Silva?
Departments of Electrical and Mechanical? Engineering
University of British Columbia
Vancouver, B.C. V6T lZ4, Canada
shahram@ee.ubc.ca

Abstract- Gravitational and friction terms play an such an approach, the two hand levers are replaced by
important role in achieving high performance control of a 4-DOF joystick (three translational and one rotational
heavy-duty hydraulic machines, such as excavators. In degree of freedom). The operator is able to directly con-
this paper, a new approach for decoupled estimation of the trol the motion of the implement in Cartesian-spacerather
gravitational parameters is presented. Static experiments than coordinatinlg the movements of all links to provide
are carried out with an instrumented computer-controlled desired endpoint (bucket) motion.
mini excavator to estimate the gravitational parameters. To perfom cIosed loop computer control, several
Load pins are used for indirect measurement of the joint displacement, fluid pressure and force sensors are required
torques from cylinder reaction forces. It is investigated and the pilot stage of the main valves has to be modified.
via experiments that bucket payload can be estimated with Identification of the gravitational parameters and actuator
a 5% accuracy. Furthermore, direct measurement of the friction analysis can be performed using these sensors.
actuators' friction shows that considerable amount of static Joint torque sensors for electric motor robots such
friction exists inside the cylinders that cannot be neglected. as PUMA have been designed and reported in the litera-
ture [3,4]. This is useful for implementation of the joint
1. INTRODUCTION torque control, reduction of the effective friction and mea-
surement of the external forces [3,4]. A new approach is
The mini excavator is a heavy-duty himan-operated
proposed here for sensing the joint torques of a hydraulic
hydraulic machine. This machine has a manipulator-like
machine, which is based on load pin force sensors installed
structure as shown in Figure 1. Typically, a human opera-
on hydraulic cylinder hinges.
tor controls the main four links of the manipulator in joint-
space coordinates through movements of two 2-DOF me- Application of force feedback to heavy-duty hy-
chanical hand levers. Considerable improvements in the draulic manipulators has been addressed in [2,5,6]. In-
performance of these types of machines cam be achieved direct measurement of the endpoint forces is required in
by computer-assisted control [I]. Indeed, human factor order to implement master-slave force-reflecting resolved
experiments have shown that resolved-mode endpoint ve- motion control. In [5,6], the endpoint forces were mea-
locity control leads to faster task completion time [2]. In sured from cylinder pressures. Because of the actuator
friction (or sealing friction), force measured from cylinder
pressures is not a suitable representation of the external
force. An alternative method is proposed here to estimate
the gravitational parameters and to measure the endpoint
forces.
This paper is organized as follows: Machine instru-
mentation is brilzfly explained in Section 2. The new ap-
proach for decoupled estimation of the gravitational pa-
rameters is introduced in Section 3. Joint torque measure-
ment using the installed sensors is explained in Section
4. Experimental results for estimation of the gravitational
parameters are reported in Section 5. Bucket load estima-
Figure 1. Schematics of the mini excavator tion using the idlxtified parameters is presented in Section

0-7803-2988-4/96 $4.00 0 1996 1EE.E 329


6. Section 7 is devoted to the analysis of the static fric- Now, define the static parameter vector $8 as follows:
tion inside the actuators. Conclusions and future work are
outlined in Section 8.

2. MACHINE INSTRUMENTATION
The following sensors have been installed on each of
the backhoelactuators :
U A linear position sensor to measure the piston displace-
ment.
cl A load pin to measure the reaction force of the cylinder
to its hinge. This reaction force sensor is sensitive to Intuitively, we expect all these parameters to be positive.
both tension and compression. In Figure 1, the load pins Using the definition (3), equations (2) can be expressed in
for the bucket, stick and boom are designated as A, B, the following decoupled vector forms:
C. Note that these load pins are fixed to the body of - -
the machine. Reaction force and torque sensors have
been explained in [7]. - -
0 W Ohydraulic pressure sensors to measure the line (4)
pressures.
The pilot stage of the main valves has also been modified
to be able to control the machine by computer [8]. This
issue is not studied here, because the experiments are done where C234 = ~ 0 ~ ~ 62 = ~ 4 and
3~ sin623 ~ so on. Thus, the
with the manipulator in the idle condition. The sensors gravitational parameters can be determined from the three
and the modified pilot valve have been connected to a decoupled equations of the form Ar = W T g ,where the
VME-bus based computer system. The resolver outputs regressor vectors W are functions of the link angles with
are connected to an IUD board in the VME cage. All horizontal plane.
other sensor outputs are directed to the A D board in the
If the static experiment is repeated n times for different
VME cage. configurations of the manipulator, three composite coef-
ficient matrices with n rows and 2 linearly independent
3. ESTIMATION OF THE columns are obtained. Thus the parameter vector g3can
GRAVITATIONAL PARAMETERS be estimated using the linear least squares algorithm.
Assuming that there is no load in the bucket and Note that according to definition (3), the parameters
the manipulator is not actuated, the torque measured at are constant if the centers of gravity are fixed within their
each joint is produced by the gravitational forces on the
bucket, stick and boom links. Figure 2 shows a schematic
representation of the manipulator links. The assigned joint I
‘23
angles are ( 6 2 , 0 3 , 0 4 ) . The cab swing angle is not shown
in Figure 2, as it is not considered in this study. In Figure
2, cgi is the center of gravity for link i with the polar
coordinates (ri a i ) in the corresponding link.
The Link angles with respect to the horizontal plane are

02, 823
A
= o2 + e3, A
0234 = 023 + 84 (1)

The joint torque equations are as below:

Figure 2. Gravitational forces on the links. Note that


The term “backhoe” denotes to the bucket, stick and boom links. for this configuraticn, O2 > 0,623 < 0 , 6 2 3 4 < 0 .

330
links. Because of the cylinders and their minor linkages, Using the trigonomletric relations for the four-bar linkage,
this assumption is not correct. In other words, cgts depend the mapping 8(2) was obtained. It was verified that e($)
on the manipulator configuration. In spite of this fact, for can be approximated with the following polynomial:
simplicity, we assume that egis are fixed. The variation of
the egis would affect standard deviation of the estimated e = -417.6293~~+ 2 0 4 9 . 1 -~ ~4 0 1 9 . 9 ~ ~
parameters. The parameters which are more depiendent on +3939.4z2 - 1932.12 + 380.5009 (5)
the location of cg:s will be estimated with higher standard
deviations. With this approximation, the maximum angular error was
0.3 degree, which corresponds to a negligible position
In the next section, we explain how this experiment
can be carried out using the outputs of the installed sen- error of 3.7" at the bucket tip. Piecewise polynomial
approximation can be used to achieve higher accuracy, if
sors.
necessary. Figure 4 shows the polynomial e(z) and its
derivative J ( z ) for the full range of bucket motion.
4. JOINT TORQUE MEASUREMElNT
The only position sensors are the linear sensors in-
stalled on each actuator. Using the geometry of the ma- I I
chine, the trigonometric mapping between linear displace-
ment of each piston and corresponding joint angle can be
found. This mapping (8(z)) is essential to find1 the joint
angles given the piston displacements. In addition, as will
be explained, its derivative J dO/dz can be used to de-
rive the joint torques from load pin readings, and also to
convert linear velocity of the piston to angular velocity of
the joint. Instead of using the trigonometric mapping to I I '-20
calculate O(z0) and its derivative J ( z 0 ) for a given x o , 0.8 1 1.2
it is beneficial to use polynomial approximation for e( x ) . x (m)
Horner's algorithm [9] can be used for recursive calcula- Figure 4,. Polynomial approximation
tion of the polynomial and its derivative for a given piston for the bucket actuator.
displacement. For an n-th order polynomial, 211-1 multi-
plications and 2n-1 additions are needed to calculate the In Figure 3, the joint torque r is due to the weight of
polynomial and its derivative [9]. Therefore, for our 5th the bucket. Neglecting the joint friction, the virtual work
order polynomial 9 multiplications and 9 additions are re- principle [lo] implies that
quired for simultaneous calculation of e(zo) and J ( x o )
for a given 20.This is particularly important for real time rde = Fdx, (6)
calculations.
where F is the gravity force on the bucket piston. In
Let's discuss the bucket actuator in detail. The stick a static condition, where the main valves are all closed,
and boom actuators can be dealt with similarly. Figure 3 Newton's third law gives
shows the bucket actuation system.
F,. = F
(7)
load pin , Fp = F - Ff
where,
F,. = reaction force sensed by the load pin,
Fp = PlA1- P& = the force measured from pressure
readings,
Fj = static friction between the piston and cylinder.
According to (7),
1. Due to the static: friction inside the actuator, load pin
reading is a more: accurate representation of the external
force than the force measured from pressure sensors.
2. Actuator friction can be directly measured from load
pin output and cylinder pressures, i.e., Fj = F,. - Fp.
Figure 3. The bucket degree of freedom

331
Equations (6) and (7) can be combined to obtain the bucket torque estimation
following expression for the bucket joint torque, 600 1 1 1 I I
I I I I I

T(20) = F,/J(zo). (8)


Finally, using the chain rule, the following equation for
conversion of piston linear velocity to the joint angular
velocity is obtained.

e(t) = i ( t ) ~ ( z ) (9) -600' I 1 I I I J


20 40 60 80 100
sample
5. EXPERIMENTAL RESULTS
stick torque estimation
The static experiment described in Section 3 was re- 2000 I I I I I
peated n = 110 times for different configurations of the I I I I I

manipulator. The sensor outputs were recorded for off-


line analysis. Using the polynomial approach explained
in Section 4, the joint angles and joint torques were cal-
culated for each configuration. The linear least squares
algorithm was used to identify the gravitational parame-
ters. Standard deviation of the estimated parameters were I I I I I
I I I 1 I
calculated using the method explained in [ll]. The esti- -2000
20 40 60 80 100
mated parameters and their standard deviations are listed sample
in Table 1. boom torque estimation

I I I I I

E
i

I I I I I
"
20 40 60 80 100
sample

Figure 5. Measured (solid line) and


estimated (dotted line) no-load joint torques.

Table 1. Estimated parameters and their


standard deviations.

According to Table 1, the parameters ( p ~p4, ) es-


, p ~ are
timated less accurately compared to the other parameters.
Therefore, these parameters must be more sensitive to the
variation of the links centers of gravities (see definition
(3)). Table 2. No-load torque estimation errors.
Figure 5 shows the measured joint torques and their
Using the identified parameters in Table 1, the no-
estimated values using the parameters of Table 1. Accord-
load static joint torques can be estimated from joint angles.
ing to Figure 5, the torque estimation of the bucket link
This can be employed to;
has higher relative errors than the stick and boom. Bucket
joint friction is the main reason. Note that the bucket is 1. Improve the trajectory tracking performance by gravity
less heavy than the stick and boom, and therefore its grav- compensation.
itational torque is comparable to its joint friction. Stan- 2. Measure the external forces applied to the manipulator.
dard deviations of the torque estimation errors are listed In particular, bucket load estimation is studied in the
in Table 2. next section.

332
bucket
6. BUCKET LOAD ESTIMATION o1 1
I
I
I
I
I
I
I 1
A A A
Define 734 = 73 - 74, 723 = 72 -73 ancl 724 = 7 2 -74.
Equations (2) can be reformulated as:
( ~ 3 4=
) Ma,ga3cos823+M,tgr3cos(B23+
~ ~ m),
( 7 2 3 ) ~=~(Mbu+Mst)gaZcos& +Mbogr2cOs(62 +a2).
(10)
Here NL corresponds to the no-load condition. Now, with
a mass M inside the bucket, the torques change to 2 4 6 8 1 0
sample
734 = (734)N,5+ MSa3C23, (11)
723=(723)~~ + Mga2cZ. stick

Three methods to measure the load, based on equations


(11) are:
1
M = -(%4 - (54)NL)r
ga3c23
1
M = -(723 -(723)~~),
ga2c2
1
(724 - ( 7 2 4 ) i ~ ~ ) .
2 4 6 6 1 0
M =
+
ga2c2 ga3C23 sampre

The denominator of the first two expressions may ap- boom


18300 I I 1 I
proach zero for some specific configurations of the ma- I I I I
I I I
nipulator. Since the denominator of the last expression is
always positive (due to the joint angle limitations), it will
be used for bucket load estimation. Using equation (4)
for no-load joint torques, we obtain
h
= 72 - 74 - gC23P3 + gS23P4 - SC2(05 + gs2(96
+ ga3C23
(13)
With a known load of M = 100Kg inside the bucket, sample
the manipulator was put into ten different configurations.
Figure 6 shows the measured joint torques and the esti- Figure 6. Measured joint torques with load (0)and
mated no-load torques. The following estimated values estimated no-load torques (*) of the backhoe links.
were obtained using equation (13):
M^=100.88, 103.63, 98.07, 98.47, 102.74 7. ACTUATORS' STATIC FRICTION
(14)
102.02,103.37, 95.76, 98.18, 99.07 As explained in Section 4, it is better to use load
which has a mean of 100.22Kg and standard deviation of pin outputs to calculate the joint torques. Experiments
= 2.68Kg. with the mini excavator and other experiments reported
The main sources of error are: in [SI show that if pressure readings are used for torque
measurements, the results would be erroneous. This is
The load pins are connected to the body of the ma- mainly due to the significant static friction that exists
nipulator instead of the cylinder, therefore, due to the inside the actuators, as was pointed out by the authors
small rotation of the cylinders, they are not measuring of [5].
the whole reaction force. In the future, we will calcu-
late the cylinder angle w.r.t. the corresponding load pin Figure 7 shows the measured force of the bucket
axis to eliminate this measurement error. actuator (Fr and 3'') and calculated static friction
As discussed earlier, because of the cylinders and their ( F f = Fr - I$)using the n=l 10 trials of the static exper-
minor linkages, the assumption that the gravitational iment. According to Figure 7, considerable static friction
parameters are fixed is not correct. exists inside the bucket actuator.
The geometry of the machine was not available and tape The mean and standard deviation of the static friction
measuring was used to find the lengths. inside the backhoe actuators are listed in Table 3.

333
bucket force (F, and F p ) An important property of a general rigid-body ma-
8000I I 1 I , I 1
nipulator dynamics is its linearity in a set of well-defined
parameters 9 [lo]. In this paper, the static parameter vec-
tor &s was estimated, which is in fact a subset of the
complete parameter vector 9 = 9 7 1 ~our . fu-
ture research will focus on estimation of 2,employing
dynamic experiments.
Acknowledgment- This work was supported by
NSERC NCE IRIS grant #5-58305, NSERC equipment
grant EQP0140043 and B.C. Advanced Systems Institute
Fellowship grant #5-56296.
I
I
I
I
I
I
I
I
I
I
REFERENCES
[l] N. Sepehri, P.D. Lawrence, F. Sassani and R. Frenette,
“Resolved-mode teleoperated control of heavy-duty hy-
draulic machines,” ASME Journal of Dynamic Systems,
Measurement and Control, vol. 116, pp. 232-240, June
1994.
[2] P.D. Lawrence, S.E. Salcudean, N. Sepehri, D. Chan,
20 40 60 80 100 S. Bachmann, N. Parker, M. Zhu and R. Frenette, “Coordi-
sample
nated and force-feedback control of hydraulic excavators,”
Figure 7. Bucket forces and static friction. Proc. of the 4th Int. Symp. on Experimental Robotics,
ISER’ 95, Stanford, CA, pp. 114-121, June 1995.
[3] D. Vischer and 0. Khatib, “Design and development of
high-performance torque-controlled joints,” IEEE Trans.
on Robotics and Automation, vol. 11, no. 4, pp. 537-544,
August 1995.
[4] J.Y.S. Luh, W.D. Fisher and R.P.C. Paul, “Joint torque
control by a direct feedback for industrial robots,” IEEE
Trans. on Automatic Control, vol. AC-28, no. 2, pp.
153-161, February 1983.
Table 3. Actuators’ static friction [5] N.R. Parker, S.E. Salcudean and P.D. Lawrence, “Ap-
plication of force feedback to heavy duty hydraulic ma-
8. CONCLUSION chines,” Proc. of the IEEE International Conference on
Robotics and Automation, pp. 375-381, 1993.
Estimation of the mass related (gravitational) param- [6] M. Zhu, “Master-slave force-reflecting resolved mo-
eters of a mini excavator system was considered in this tion control of hydraulic mobile machines,” Master’s the-
paper. Load pin readings were used to calculate the joint sis, Department of Electrical Engineering, University of
torques. Decoupled static equations of the joint torques British Columbia, April 1994.
were obtained and the least squares estimation were ap-
[7] C.W. de Silva, Control Sensors and Actuators.
plied to these equations. The identified parameters were
Prentice-Hall, Englewood Cliffs, NJ, 1989.
used to estimate the bucket load. According to the ex-
perimental results, payload estimation using load pins can [8] P. Peussa, D. Chan, S. Bachmann, P.D. Lawrence, S.
be performed within 5% accuracy. Since it was found Tafazoli and S.E. Salcudean, “Using solenoid valves for
that considerable static friction exists inside the actuators, proportional pilot pressure control in mini excavators,”
therefore pressure readings were not used to measure the Proc. of the 4th Scandinavian International Conference,
joint torques. Tampere, Finland, pp. 1139-1151, September 1995.
The estimated gravitational parameters will be used [9] R.L. Burden and J.D. Faires, Numerical Analysis.
in the future to compensate for gravity in the control of PWS Publishing Inc., Boston, MA, 1993.
the implement and to measure the external forces applied [lo] F.L. Lewis, C.T. Abdallah and D.M. Dawson, Control
to the manipulator (for force feedback experiments). This ofRobot Manipulators. Macmillan, New York, NY, 1993.
will significantly improve the performance of the teleop- [ l l ] K.J. h o r n and B. Wittenmark, Adaptive Control.
erated hydraulic machines. Addison-Wesley, Reading, MA, pp. 58-64, 1990.

334

Das könnte Ihnen auch gefallen