Professional Documents
Culture Documents
C
=
B
+(0
3
k
C
=
B
+(0
3
k
) +
B
(0
3
k
)
v
C
= v
B
+(0
3
k
) r
BC
(1)
v
C
= v
B
+
C
r
BC
+
B
(
B
r
BC
)
Where:
B
,
B
,
C
, onJ
C
are the angular velocity and angular acceleration
of the previous link the boom and stick, respectively. v
B
, v
B
, v
C
, onJ v
C
are the
translational velocity and translational acceleration at joint point B and C of
the boom and stick, respectively. 0
3
and 0
3
are the angular velocity and
angular acceleration of the local coordinate system of the stick relative to that
of the boom. The inertial force, F
3
3
and moment, H
3
3
acting on the stick can
then be determined by applying the Newton-Euler's equation. The
mathematical model in the local coordinate frame (about the gravitational
center of the stick) is given by equation (2). m
3
and I
3
are the mass and inertial
moment of the stick, respectively. From the free body diagram of the stick, all
forces and moments are balanced resulting in the balance equation (3).
H
3
3
= I
3
C
+
C
(I
3
C
) (2)
F
3
3
= m
3
v
C
3
H
B
+H
C
+ r
C
3
B
F
B
+r
C
3
B
F
C
+ r
C
3
I
F
S
= H
3
3
(3)
F
B
+F
C
+F
S
= F
3
3
Where: F
B
and F
C
are the forces acting on the stick from the boom and bucket,
respectively, and expressed in the local coordinate frame. F
S
is the hydraulic
force exerted on the stick by the stick cylinder. H
B
and H
C
are the moments
acting on the stick from the boom and bucket, respectively, and expressed in
the local coordinate frame. The force balance equations can be established for
the boom and bucket as well.
The complete set of the equations for describing the kinematics and
dynamics of the boom, stick and bucket assembly involves near fifty equations,
which can be solved for unknown parameters based on prescribed inputs. For
example, with a given digging trajectory and the digging force at the tip of the
bucket, it is possible to calculate joint forces between links and hydraulic
forces inside three cylinders, therefore, establishing the relations among the
digging force, hydraulic forces and other factors [Alekseeva, et. al, 1985].
The interaction between the bucket and the excavated material is a
complex problem and there are different models, which are applicable to
different materials [Araya, et. al, 1988] and [Novak, A.J. 1991]. The resistive
force, Fr as shown in Figure 3 was calculated using the model by [Alekseeva,
et. al, 1985]:
F
= k
p
jk
s
bb +N +e [1 +
v
s
v
b
bb _ Ax
[ (4)
k
p
and k
s
are specific resistances in digging material; constants b and h are
width and thickness of cut slice of the material, respectively; is the friction
coefficient of the bucket and the cutting material; N is the pressure force of the
bucket with the cutting material; is the coefficient of resistance experienced
in filling the bucket during the movement of the prism of soil; V
s
and V
b
are
volumes of the prism of cutting material and the bucket, respectively; and !x
i
is the increment along the horizontal axis. "
b
defines the angle between the
foregoing plane that contains the bottom of the bucket and the X
4
-axis. The
digging angle, "
dg
, is defined as the tangential angle of the proscribed
trajectory with the horizontal line. With the time dependence of the trajectory
known, the digging angles with time can be determined for each instant during
the excavation process. F
t
and F
n
are the tangential and normal components of
the resistive force.
Excavator performance is defined as power consumption of all cylinders
during digging operation. The power delivered to each cylinder is the product
of the force applied by that cylinder and the extension rate of this cylinder
(assuming ideal hydraulic cylinders). Novak and Larson (1991) estimates the
power delivered to the boom cylinder in equation (5).
P
b
= |F
b
. I
b
| (5)
F
b
and I
b
are the hydraulic force and extension rate of the boom cylinder,
respectively. The total power required to drive the excavator is simply the sum
of these individual powers:
P
totuI
= |F
b
. I
b
| + |F
s
. I
s
| + |F
bu
. I
bu
| (6)
F
s
and I
s
and F
bu
and I
bu
3
u
1
_ =
_
cos(0
1
+ 0
2
+ 0
3
) -sin(0
1
+ 0
2
+ 0
3
) u l
1
cos 0
1
+l
2
cos(0
1
+0
2
)
sin(0
1
+0
2
+0
3
) cos(0
1
+0
2
+0
3
) u l
2
sin 0
1
+l
1
sin(0
1
+0
2
)
u
u
u
u
1 u
u 1
_ _
x
3
y
3
u
1
_(12)
Similarly, the global coordinates of point in boom or stick can be obtained
by same method.
Based on above transformation matrix, inverse kinematics and forward
kinematics can be studied. Forward kinematics analysis is to obtain trajectory
of bucket tip or other points in components according to the angle of each joint
in joint space. On the other hand, if the trajectory of bucket tip is known, the
processing of solving joint angle is called inverse kinematics. In the two
processes, the forward kinematics is simpler than inverse kinematics. In
inverse kinematics analysis, solution of algebra equation is necessary. In most
cases, the algebraic equations are nonlinear. In hydraulic excavator, neglecting
motion of tract, equation (12) can be used to perform inverse kinematics
analysis. If only the trajectory of tip is given, the angle of each joint is not
unique. So another constraint of orientation of bucket should be added. It
means that knowing the angle of (0
1
+ 0
2
+0
3
), the angle of 0
1
, 0
2
, 0
3
can be
determined. If the trajectory of bucket is given, the two angles and
displacement must be fixed.
In hydraulic excavator, hydraulic cylinders are actuators to overcome the
resistive force and drive components. These hydraulic cylinders form three
kinematics constraint relationships as follows :
c
1
2
= (b
1x
cos 0
1
- b
1
sin0
1
-b
ox
)
2
+ (b
1x
sin 0
1
- b
1
cos 0
1
- b
o
)
2
(13)
c
2
2
= (l
1
+ b
21x
c
2
-b
21
s
2
- b
12x
)
2
+(b
21
sin0
2
-b
21
cos 0
2
- b
12
)
2
(14)
c
3
2
= (l
1
+l
1
c
2
+b
31x
c
23
- b
31
s
23
-b
13x
)
2
(15)
c
1
is the length of boom cylinder; c
2
is the length of stick cylinder; c
3
is the
length of bucket cylinder; h
ox
and h
oy
, the coordinates value of a point on boom
cylinder in undercarriage; h
1x
and h
1y
, the coordinate value of point of boom
cylinder in undercarriage; h
21x
and h
21y
, the coordinate value of a point on stick
cylinder in stick; h
12x
and h
12y
, the coordinate value of a point of stick cylinder
in boom; h
31x
and h
31y
, the coordinate value of a point of bucket cylinder in
bucket; h
13x
and h
13y
, the coordinate value of a point of bucket cylinder in
boom. Based on transformation matrix, the velocities and accelerations can
individually be derived. The bucket velocities and accelerations are:
_
X
u
1
_
#
=
l
l
l
l
-sin 0
123
0
123
-cos 0
123
0
123
u -l
1
sin 0
1
0
1
- l
2
sin 0
12
0
12
cos 0
123
0
123
-sin 0
123
0
123
u l
1
cos 0
1
0
1
+ l
2
cos 0
12
0
12
u
u
u
u
1 u
u 1
1
1
1
1
_
x
y
u
1
_ (16)
_
X
u
1
_
"
=
l
l
l
l
l
-sin 0
123
0
123
-cos 0
123
0
123
2
-cos 0
123
0
123
+ sin 0
123
0
123
2
u o
1
cos 0
123
0
123
- sin 0
123
0
123
2
-sin 0
123
0
123
- cos 0
123
0
123
2
u o
2
u
u
u
u
1 u
u 1
1
1
1
1
1
(17)
Kane method is used to develop and analyze the structure of the static and
dynamic problems associated with the hydraulic excavator. The process begins
with defining the general speeds u
1
,u
2
... u
n
first; then the forces acting on the
system are calculated, including external forces (F
)
]
, torques (
)
]
, inertial
forces (F
)
]
)
]
+F
= u (1!)
where:
F
= "#(F
$I
$%
+ (
$&
$%
'
(
)1
F
= -m
= -I
; F
= _ j(F
*v
+
*u
,
+(
*-
+
*u
,
[
(
)1
The general speeds are given as: u
1
, u
2
, u
3
:, where %
1
= 0
1
, %
2
= 0
2
%
3
= 0
3
. Then we can solve the partial velocity for different velocities. For
example, for the points in the bucket, the partial velocities are shown as
follows :
*.
3
*/
+
= #
-sin 0
123
-cos 0
123
cos 0
123
-sin 0
123
' 0
x
y
1 +#
-sin 0
12
-cos 0
12
cos 0
12
-sin 0
12
' 0
l
2
u
1 +
#
-sin 0
1
-cos 0
1
cos 0
1
-sin 0
1
' 0
l
1
u
1 (12)
Differentiating equation (13,14 and 15), the relationship between the
velocities of cylinder and linkage angle can be obtained as shown below :
*3
4
*/
4
=
1
3
4
5b
6x
(b
1x
s
1
+ b
1
c
1
) - b
6
(b
1x
c
1
+b
1
s
1
)7 (2u)
*3
8
*/
8
=
1
3
8
5(l
1
- b
12x
) (-b
12x
s
2
-b
21
c
2
) -b
12
(b
21
c
2
- b
21
s
2
)7 (21)
*3
3
*/
8
=
1
3
3
5(l
1
- b
13x
) (-l
2
s
2
-b
31x
s
23
- b
31
c
23
) +(-b
13
)(l
2
c
2
+b
31x
c
23
-
b
31
s
23
)9 (22)
h
21x
and h
21y
are coordinate values of a point of arm cylinder in stick.
The entire external forces incident on the excavator are included in
developing the system static model. These forces include the hydraulic force
from cylinders, gravity of the handle, the payload for digging resistance and
gravity of material as shown below.
1
*3
4
*/
4
+F
*s
4
*/
4
+H
1
:(x
1
cos 0
1
-y
1
sin 0
1
) + H
2
:(l
1
cos 0
1
+x
2
cos 0
12
-
y
2
sin 0
12
) + H
3
:(l
1
cos 0
1
+l
1
cos 0
12
+x
3
cos 0
123
- y
23
sin 0
123
) = u (2;)
2
$c
2
$0
2
+
3
$c
3
$0
2
+ F
$s
$0
2
+H
2
:(x
2
cos 0
12
- y
2
sin 0
12
)
+H
3
:(l
2
cos 0
12
+ x
3
cos 0
123
-y
3
sin 0
123
)
= u (24)
3
*3
3
*/
3
+ F
*s
*/
3
+ H
3
:(x
3
<=>0
123
-y
3
>?@0
123
) = u (2A)
According to above static equations, some physical significance of items
can be studied. The three equations are corresponding to three general speed
u
1
, u
2
and u
3
.
Therefore,
1
*3
4
*/
4
;
2
*3
8
*/
8
+
3
*3
3
*/
8
and
3
*3
3
*/
3
*/
4
,
*3
4
*/
4