The kinematics analysis and trajectory planning of Series robot

International Journal of Research in Engineering and Science (IJRES)
ISSN (Online): 2320-9364, ISSN (Print): 2320-9356
www.ijres.org Volume 3 Issue 12 ǁ December. 2015 ǁ PP.01-06
www.ijres.org 1 | Page
The kinematics analysis and trajectory planning of Series robot
Wang Chunyan1
, Xu Yong2
1
(College of Mechanical Engineering, Shanghai University of Engineering Science, China)
2
(College of Mechanical Engineering, Shanghai University of Engineering Science, China)
ABSTRACT:
In this paper, a series robot as the research object, using theoretical analysis, numerical simulation method of
combining, to carry out the overall performance analysis and optimization of industrial robots trajectory. For serial
robot, kinematics modeling. The establishment of a first-order influence coefficient method based on
second-order influence coefficient matrix, kinematic and dynamic analysis of performance indicators based on
both Jacobin matrix and Hessian matrix, and the actual size of the work and working space agencies, institutions
initially selected size. Finally, institutional performance indicators for institutional map drawing performance,
combined with the flexibility and maneuverability determine the size of a set of different institutions in the
optimal configuration, and its feasibility through simulation. According to the geometric characteristics of the
surface complex surface fragmentation process, solve the optimal value speed and coating spray width of the
overlapping area on each patch.
Key words：Series robot; kinematics analysis; Position; trajectory planning
I. 0 INTRODUCTIONS
How to improve the performance of the robot's movement has been one of the main issues of concern scholars,
but also the research focus in the field of robotics. About sports performance of the robot manipulator, the expert
presented a different performance indicators: 1982 Salisbury proposed the concept of the condition number of
Jacobian matrix; 1983 and 1985 Yashikawa introduction of the "operational" concept; 1985 Yang defines the robot
operand is the condition of this concept; Gosselin in 1991 to optimize the movement of the robot design, defines
the global performance indicators. In this paper, the overall performance of kinematic and dynamic properties of a
series of research institutions.
First we need to establish the institution of a first, second influence coefficient matrix, and according to the
first, second global influence coefficient matrix defined performance indicators and given the global performance
of the institution. Since the parameter setting mechanism is reasonable performance directly determining means,
the paper size by changing mechanism section member, study its motion in different dimensions of global
indicators to explore the performance differences agencies, resulting in a set of different size organization, select
sports performance is more excellent institutions.
Meanwhile, in order to make better complete spray painting robot task, but also on the spray trajectory planning,
the use of standard spray valve surface fragmentation process, obtaining spray coating speed and the optimal value
of the width of the overlapping area of each surface, This will reduce the production cost.
II. Configuration Description
First, for the following figure robot dynamic modeling, as can be seen, the subjects of 6-DOF serial open
chain robot, its DH parameter table O-X_0 Y_0 Z_0 polar coordinates, in turn establish joint axis in each joint

coordinate system (Figure 1), a_1, a_2, d_1, d_2 structural parameters institutions, θ_1 articular angle, α_1 for the
twist angle, the link parameters listed in the table shown below,
Fingure1 the mechanism of the Serial Robot
关节
cma ii /)1( 
cmdi /
)/()1(   ii
i 关节变量范围 )/(
1 0 45 0 1 -150~150
2 15 0 90 2 -90~150
3 57 0 0 3 -180~180
4 20 0 90 4 -150~150
5 0 64 -90 5 -180~180
6 0 0 90 6 -200~200
工具 0 17 0 0 0
Figure 2 link parameter table
While the little robot end effector for the study, according to the established coordinate system transformation
matrix required between two neighboring rods. The table parameters are substituted into the coordinate system i
and i-l homogeneous coordinate transformation matrix i-1Ai
(1)
The possible transformation matrix, :
1
cos cos sin sin sin cos
sin cos cos sin cos sin
0 sin cos
0 0 0 1
i i i i i i i
i i i i i i ii
i
i i i
a
a
d
     
     
 

 
  
 
 
 
A
11 1 ( , ) 1 1 1
1 1 1 1 1 1 1
1 1 1 1 1 1 1
1
1 1 1
(0,0, ) ( ,0,0) ( , )
0
0 0 0 1
n
n
n n z n n n
n n n n n n n
n n n n n n n
n
n n n
T A Rot Trans d Trans a Rot x
C S C S S a C
S C C C S S
A
S C d
 
     
      
 
    
      
      

  
    
 
  
 
 
 

And then find the total transformation matrix：
Obtained：
(2)
(3)
This paper is based on the use of performance indicators influence coefficient method. When the initial parameters
of the mechanism to the timing, influence coefficient method can be obtained in accordance with a first order
influence coefficient matrix G of the institution and the second-order influence coefficient matrix H. Here
resulting first order influence coefficient matrix (Jacobian matrix) G of 6 × 6 array, the second-order influence
coefficient matrix (Hessian matrix) H of 6 × 6 × 6 array. Performance is defined as the impact of the condition
number of the coefficient matrix
(4)
GK VGW

G= V
(5)
(6)
Wherein, GX is a first order influence coefficient matrix of the Jacobian matrix of the first three rows, G_w ^
+ number as the Frobenius norm, G_ + is the generalized inverse matrix; G_v is three lines after the first-order
influence coefficient matrix Jacobian matrix, H is Hessian matrix of second-order influence coefficient matrix.
Construction serial robot first order influence coefficient matrix, S_j, j = 1,2, ⋯ 6, can be obtained.
1 2 3
R
H nT A A A A 
4 5 6 4 6 4 5 6 4 6 4 5
4 5 6 4 6 4 5 6 4 6 4 52 3
6 3 4 5 6 3 6
5 6 5 6 5 3
0
0
0 0 0 1
c c c s s c c s s c c s
s c c c s s c s c c s s
s c s s c d
   
      
 
 
 
T A A A A A T
0 1
6 1 2 3 4 5 6 1 6
0 0 0 1
x x x x
y y y y
z z z z
n o a p
n o a p
n o a p
 
 
   
 
 
 
T A A A A A A A T
GK WGV

G= W
HHKGV

=

Figure 2 the construction of Series robot
Change posture, setting different agencies size, adjust the parameters in the software, and analyzes the
direction of the velocity, acceleration curves, combined with the impact factor performance, robotic systems for
global analysis, here select two typical size, and rendering speed graph, it can be seen from Fig first group and the
second group, the first group velocity curves gently, the control means is good, on the contrary, more difficult to
control the other group configurations. So selecting the first set of dimensions better. Pick perform configuration
analysis simulation, one can verify the correctness of the calculation, on the other hand can simplify the design
process, while achieving intelligent optimization.
a. The first set of z-direction velocity curve b. a first set of z-direction velocity curve
Figure 3 z direction velocity curve
Below is plotted output different sizes in the Z direction under acceleration curve can be seen from Figure 4,
the output of the angular velocity of the first group and the second group compared to flat, which means that the
first group than the second group better achieve control, it can be concluded: the first group size is more
appropriate.

a. The first set of z-direction Acceleration curve b. a first set of z-direction Acceleration curve
Figure 4 z direction Acceleration curve
III. trajectory planning
For spray trajectory optimization, will consider the general shape of the workplace, the workplace surface
curvature, spray angle and spray distance path several ways, depending on the characteristics of the optimal path,
pipeline valve shape is relatively simple, but because of its sheet-like rather than a cylinder workpiece, so when
spraying should also consider whether the circumference can be sprayed onto, where the use of this trajectory
planning method. With the base coordinate system in the "samples" Cartesian space to regulate and convert it into
the joint space, and then use a function method to construct joint variables of curve fitting, and through the
controller drives each joint so that the robot end perform the desired trajectory, at a sufficient condition samples,
we can guarantee a better approximation robot Upon completion of the specified job task, in addition to the need
for accurate implementation of the track, but also consider themselves subject to the robot system constraints,
such as work space, speed, acceleration, jerk and torque and other constraints, when the trajectory of the robot to
meet these constraints premise, for different job tasks, trajectory planning has different optimization objectives,
common optimization goals are: the optimal time, this is to improve the operating efficiency of the system, in
many occasions, the optimization index dominated; optimum smoothness, which is to reduce the variation in the
robot joint trajectory velocity and acceleration can protect the robot joint action, the optimization index are more
often used; optimum energy, which is to reduce energy consumption systems, mainly in the energy constraint
strictly limited special occasions, according to the tendency of decision makers prefer to select one or a set of
"sufficient satisfaction" Solutions for multi-objective optimization problem as final solution. There are obstacles
in the path for the robot trajectory planning, the use of multiple algorithms five robot trajectory planning at the
same time the objective function is optimized to achieve optimal trajectory Parent.
IV. Conclusions
Aiming serial robots were analyzed by the above-mentioned research can initially draw the optimal
configuration for the institution, while adjusting parameters help to improve line speed performance, different
sizes have an impact on the overall performance of the robot, by Trend Watch organization dimensional change,
provide a theoretical basis for the design of high performance organizations.
Through the study of robot trajectory planning, determine the trajectory of spray painting robots. Lay the
foundation for future research.
REFERENCE
[1] Tsai L W. Robot analysis, the mechanics of serial and parallel manipulators [M]. New York, USA: John Wiley and Sons, 1999.
[2] Kucuk S, Bingul Z. The inverse kinematics solutions of industrial robot manipulators [C] //Proceedings of the IEEE International
Conference on Mechatronics.Istanbul, Turkey: IEEE, 2004: 274-279.

[3] Manocha D, Canny J F. Efficient inverse kinematics for general 6R manipulators [J]. IEEE Transactions on Robotics and
Automation, 1994, 10(5): 648-657.
[4] Duffy J, Crane C. A displacement analysis of the general spatial 7R mechanism [J]. Mechanism and Machine Theory, 1980, 15(3):
153-169.
[5] Lee H Y, Reinholtz C F. Inverse kinematics of serial-chain manipulators [J]. ASME Journal of Mechanical Design, 1996, 118(3):
396-404.
[6] Gosselin C, Angeles J. A Global Proformance Index for the Kin- ematic Optization of Robotic Manipulators [J]. Transactions of
the ASME, 1991,113: 220-226.
[7] Lee H Y, Liang C G. Displacement analysis of the spatial 7-link 6R-P linkages [J]. Mechanism and MachineTheory, 1987, 22(1):
1-11.

The kinematics analysis and trajectory planning of Series robot

More Related Content

What's hot (20)

Viewers also liked (14)

Similar to The kinematics analysis and trajectory planning of Series robot (20)

More from IJRES Journal (20)

Recently uploaded (20)

The kinematics analysis and trajectory planning of Series robot