Mathematical Modeling of Robot Manipulator the with Four … · 2016. 10. 31. · Mathematical Modeling of the Robot Manipulator with Four Degrees of Freedom 4425 ixx ixy ixz i i
This document is posted to help you gain knowledge. Please leave a comment to let me know what you think about it! Share it to your friends and learn new things together.
Transcript
Global Journal of Pure and Applied Mathematics.
ISSN 0973-1768 Volume 12, Number 5 (2016), pp. 4419-4429
ITMO National Research University (ITMO University), Head of Software Development Chair, 197101 Saint Petersburg, 12 Gastello Str., office 311,
Russian Federation.
Sergei Evgenievich Ivanov
ITMO National Research University (ITMO University), Department of Information Systems, 197101 Saint Petersburg, 49 Kronverksky Pr., Russian Federation.
Abstract
The nonlinear mathematical model of an industrial robot manipulator with
four degrees of freedom is developed. For creation of the equations of robot
manipulator is applied the matrix method and Lagrange equations of the
second kind.
The robot manipulator is designed to create automated complexes for service
of devices, for removing and installing the equipment, change of details and
tools.
The kinematic structure of the robot manipulator and the dynamic
characteristics of motion for robot manipulator are defined. The mathematical
model is presented by nonlinear system of four ordinary differential equations
of second order. The analytical solution of the nonlinear system is obtained by
method of polynomial transformations. The power of actuators and
generalized forces for move the gripping device at a given point of space for a
certain period of time are defined.
Keywords: the nonlinear mathematical model, the industrial robot
manipulator, the dynamic characteristics of the robot manipulator.
4420 Tatiana Victorovna Zudilova & Sergei Evgenievich Ivanov
INTRODUCTION
The robots manipulators are widely used in many fields and spheres of human activity:
assembly production, machining, heat treatment.
The industrial robot manipulator is an automatic machine, which includes the
manipulator with four degrees of freedom. The robot manipulator performs functions
similar to the human hand and is controlled by operator or automatically. In the
industrial production are used the technological manipulators for operations of
assembly and welding. The auxiliary robots manipulators are used for maintenance of
the main technological equipment for lifting and transporting [1-4].
The structure of robot manipulator consists of main elements, connected with each
other: the base, the stand, the mechanical arm, the gripping device. The working body
of the manipulator is the gripping device. The elements connecting the base with the
working body constitute a kinematic chain of the robot manipulator. The two adjacent
elements constitute a kinematic pair.
The number of degrees of freedom provides the movement of the device of gripping
in any point of the working area. The main function of the robot manipulator is
determined by kinematic scheme.
NONLINEAR MATHEMATICAL MODEL OF THE INDUSTRIAL ROBOT
MANIPULATOR
The industrial robot manipulator M20P for robotic complex is considered. The robot
manipulator is shown in Figure 1 consists of a base, the stand, hands, the gripping
device and actuators for moving and turns.
Figure 1: The industrial robot manipulator M20P
The industrial robot manipulator M20P has two translational and two rotational
kinematic pairs. The elements of manipulator are numbered starting with fixed
Mathematical Modeling of the Robot Manipulator with Four Degrees of Freedom 4421
element - the base with number of zero. The motion of clamp-unclamp for the
gripping device is not considered.
The kinematic scheme for industrial robot manipulator is shown in Figure 2 and
consists of four moving parts.
We introduce the relative coordinate system associated with elements, with the origin
at the points: 1 2 3 4, , ,O O O O . The initial coordinate system 0O we correlate with the
fixed element.
For generalized coordinates we accept: the angle of rotation around the rack - 1q ,
lifting height - 2q , the length of arms - 3q , the angle of gripping device - 4q .
The system of dynamic equations of industrial robot manipulator is obtained.
We apply the matrix method and dynamic Lagrange equations in matrix form to
produce the equations of motion [5-7].
The transition from the coordinate system 0O to 1O occurs by rotation around z
axis at an angle 1q .
The transition from the coordinate system 1O to 2O occurs by rotation around z
axis at an angle , by displacement along z axis on 2q and by rotation around x axis
at an angle / 2 .
The transition from the coordinate system 2O to 3O occurs by displacement along z
axis on 3q . The transition from the coordinate system 3O to 4O occurs by rotation
around z axis at an angle 4q , by displacement along z axis on s and by rotation
around x axis at an angle / 2 .
We introduce the radius vector of points 1,2, ,3,( )4i iO in the i-local coordinate
system:
1T
i i i iR x y z .
4422 Tatiana Victorovna Zudilova & Sergei Evgenievich Ivanov
Figure 2: The kinematic scheme
The communication of radius vectors in the coordinate system i-1 and i by means of
the transition matrix 1,i iA : 1 1, .i i i iR A R
The transition matrix from point 0O to point 1O is of the form:
1 1
1 1
01
cos sin 0 0
sin cos 0 0
0 0 1 0
0 0 0 1
q qq q
A
The matrices of the transition from point 1O to point 2O and of the transition from
point 2O to point 3O are of the form:
12
2
1 0 0 0
0 0 1 0
0 1 0
0 0 0 1
Aq
, 23
3
1 0 0 0
0 1 0 0
0 0 1
0 0 0 1
Aq
Mathematical Modeling of the Robot Manipulator with Four Degrees of Freedom 4423
The transition matrix from point 3O to point 4O is of the form:
4
34
4
4 4
cos 0 sin 0
sin 0 cos 0
0 1 0
0 0 0 1
q
A
qq q
s
The transition matrix from point 0O to point 2O is defined as the product of
matrices: 02 01 12A A A ,
1
02
1
1 1
2
cos 0 sin 0
sin 0 cos 0
0 1 0
0 0 0 1
A
q qq q
q
The transition matrix from point 0O to point 3O is obtained as the product of
matrices: 03 01 12 23A A A A ,
1 1 3
03
1
1 1 3 1
2
cos 0 sin sin
sin 0 cos cos
0 1 0
0 0 0 1
q q q qq q
Aq q
q
The transition matrix from point 0O to point 4O is defined as the product of
matrices: 04 01 12 23 34A A A A A ,
1 4 1 1
0
4 3 1 1
4 1 1 1 4 3 1 1
4 4 2
4
cos cos sin cos sin sin sin
cos sin cos sin sin cos cos
sin 0 cos
0 0 0 1
q q q q q q q s qq q q q q q q s q
q qA
q
The origin of coordinates 4O associated with gripping device in the fixed coordinate
system 0O associated with a base of rack is defined by coordinates:
4 4 43 23 1 1 1 1sin( ) sin( ) cos( ) cos( ,),O O Oq q s q q q s qx y z q .
We denote the coordinates of the gripper fingers in a coordinate system 4O
as 4 4 4( , , )x y z , then in a fixed coordinate system 0O the coordinates of the gripper
4424 Tatiana Victorovna Zudilova & Sergei Evgenievich Ivanov
fingers can be represented in the form of:
3 1 4 1 4 4 1 4 1 4 1
04 3 1 4 1 4 4 1 4 1 4 1
04 2 4 4 4
04
4
sin( ) cos( )cos( ) cos( )sin( ) sin( ) sin( )
cos( ) sin( )cos( ) sin( )sin( ) cos( ) cos( )
sin( ) cos( )
q q x q q z q q s q y qy q q x q q z q q s q y qz q x q q
x
z
The coordinates of the point 0 0 0, ,x y z , given in a fixed coordinate system 0O in the
coordinate system 4O associated with a rack, determined in the form of: