Kinematics simulation analysis and trajectory planning of a moving robot based on ADAMS
Yujuan Zhao1 , Hongping Wang2
1, 2School of Mechanical and Electrical Engineering, Changchun University of Science and Technology, Changchun, 130022, China
Mathematical Models in Engineering, Vol. 3, Issue 2, 2017, p. 71-77.
Received 20 June 2017; received in revised form 26 July 2017; accepted 5 August 2017; published 31 December 2017
The study of kinematics modeling and simulation of industrial robots is the basis of robot development and optimization. According to the configuration characteristics of a moving robot, the coordinate system and the kinematics equation of the connecting rod are established based on the DH coordinate transformation method. The kinematics positive solution problem is solved in detail. The moving robot is established by the joint simulation of Solid works and ADAMS The motion model of the moving robot is verified by the kinematic analysis, and the displacement and angle curve of the end point are obtained. The rationality of the kinematics model of the moving robot is verified. The trajectory planning of the moving robot is carried out according to the actual situation, the results show that the moving robot is running smoothly and meets the requirements, which provides an important basis for the subsequent control research.
Keywords: handling robot, kinematics analysis, ADAMS simulation, trajectory planning.
With the continuous improvement of production automation, the study of industrial robots is also constantly deepening. Zhu Hongbing  and others using ADAMS on a six-degree-of-freedom industrial robot simulation analysis, to obtain its displacement and velocity curve, verify the rationality of the movement model created; Zhang Baocheng  and others using numerical analysis software Matlab Stanford robot is used to simulate the object. Based on the kinematics of the robot, the joint displacement, velocity and acceleration curve are analyzed, and the rationality of the kinematic model is verified. ADAMS is a simulation software based on multi-body dynamics [3, 4], the use of ADAMS not only can intuitively see the movement process, but also get the corresponding displacement, velocity and acceleration curve, so the robot kinematics, kinetics analysis.
In this paper, the D-H method is used to establish a connecting rod coordinate system of six-degree-of-freedom moving robot, and its motion model is constructed. Combined with Solid works and ADAMS to simulate the moving robot, and verify the correctness of the kinematic model. At the same time, the trajectory planning of the moving robot is carried out in consideration of the actual operation of the robot. Which provides the data basis for the debugging of the six-DOF handling robot entity in practical use, and protects the handling robot to a certain extent.
2. Establishment of movement model of handling robot
In this paper, a six-axle handling robot is designed, which consists of base, waist, arm, arm, wrist and pneumatic fixture. Among them, the pneumatic fixture fixed at the wrist end flange. This machine has six degrees of freedom: (1) Space rotation of the base (2) Space pitch of the boom (3) Space pitch of the arm (4) Space rotation of the front of the arm (5) Space pitch of the wrist (6) the space of the pneumatic fixture. The first three rotating joints determine the position of the pneumatic clamp, and the latter three turn joints determine the attitude of the pneumatic clamp. The model of the moving robot is established by the three-dimensional modeling software Solid works. Figure 1 shows the three-dimensional schematic diagram of the moving robot.
Fig. 1. Schematic diagram of the overall handling of the robot
2.1. Establishment of connecting rod coordinate system
In this paper, the D-H method is used to establish the connecting rod coordinate system of the handling robot . Fig. 2 shows the connecting rod coordinate system established by the six-DOF handling robot.
Fig. 2. Handling robot connecting rod coordinate system
2.2. Positive kinematics solution
It can be seen from Fig. 2 that the corresponding joint parameters of the handling robot are shown in Table 1. Where is the length of the link , is the torsion angle of the connecting rod , is the distance of the connecting rod , is the corner of the connecting rod .
Using the generalized transformation matrix:
Table 1. Handling robot joints parameters
Joint angle / (°)
Joint twist angle / (°)
Link length / mm
Link distance / mm
The angle of the joint is allowed to change / (°)
The positive kinematics equation  of the moving robot is obtained:
among them: , , , .
In order to verify whether the transformation matrix is correct, we can assign the position of each position and joint angle shown in Fig. 2 to let , 90° be substituted into Eq. (2). As a result:
and exactly the situation shown in Fig. 2.
3. Simulation analysis of handling robot motion
3.1. The establishment of the model
According to the kinematics model of the above-mentioned handling robot, kinematics simulation and analysis are carried out by using multi-body dynamics simulation software ADAMS. First, the three-dimensional solid model of the handling robot is built through Solid Works 3D software. To facilitate the model to open in ADAMS, save the model in parasolid () format . Then open the ADAMS, will create the handling of the robot sub-module into. Second, add the joint constraints of the handling robot, as shown in Table 2. Fig. 3 shows the simulation model of the handling robot after adding the constraint.
Table 2. Handling constraints between robot components
Sports sub name
Rotate the pair
Rotate the pair
Rotate the pair
Rotate the pair
Rotate the pair
Rotate the pair
Fig. 3. 6-DOF handling robot simulation model
3.2. Simulation results and analysis
The end position of the pneumatic fixture is taken as the object of study, and the end position point MARKER_o6 is set on it. MARKER_o0 is established on the base as the origin of the coordinate. Set the rotation speed of each joint as shown in Table 3, the simulation time is 1s, measuring the end position relative to the base of the movement.
Table 3. The angle of rotation of each joint (°) / s
After the simulation, enter the post-processing interface. Fig. 4 shows the displacement of the end position relative to the origin of the link coordinate system. Fig. 5 shows the angular change of the end position relative to the origin of the link coordinate system.
It can be seen from Fig. 4, 0 s, relative to direction of the displacement is 655.0 mm, direction of the displacement is 0.0 mm, direction of the displacement is 1007.0 mm, the calculation of the two points between , The relative displacement of , direction is 655 mm, 0 mm, 1007 mm, the data of the two are in full agreement. When 1 s, the displacement of in the , and directions of is 116.0000, 23.5526 and 1369.3696 mm, the data of Table 3 is substituted into Eq. (2), and the displacements of in the , and directions of are –116.0,23.552,1369.342 mm, respectively. The error in the direction is 0, The direction of the error is 0.00255 %, in the direction of the error is 0.00202 %, we can see that the error is very small, negligible.
It can be seen from Fig. 5, 0 s, around the -axis rotation angle of –180°, around the rotation angle of 90°, around the rotation angle of 0°, that is, around , rotation –180°, 90°, relative to the attitude is , and (2) calculated results exactly the same; 1 s, around the -axis rotation angle is 150°, around the -axis rotation angle is –90°, around The angle of rotation is 0°, that is, around , rotation 150°, –90°, get relative to posture is , and (2) calculated results comparison shows that the error between the two is very small, can be ignored is not small.
Fig. 4. Displacement of end position point
Fig. 5. Angle of the end position point
4. Trajectory planning of handling robots
Considering the application of the moving robot in the actual production, the actual operation process of the moving robot is simulated by ADAMS. Use the STEP function in ADAMS to add the various joints of the handling robot [8, 9]. Table 4 shows the driving function of each joint, and Fig. 6 shows the trajectory of the trajectory of the pneumatic fixture at the end of the moving robot.
In the simulation environment, when the handling robot is running, there is no collision and interference between the joints, which conforms to the actual requirements of the movement. After the simulation, enter the post-processing interface.
Fig. 7 shows the change of the angular velocity of each joint with time. Fig. 8 shows the change of the acceleration of each joint with time. In the trajectory planning movement of the handling robot for 7 seconds, the movement of the first few seconds is the repetition of the first 1 second movement, so only the motion angular velocity and the angular acceleration curve of the 1 second before the joint of the moving robot are intercepted. Fig. 7 shows that, as time changes, the joint angular velocity changes smoothly, where the joint 4 speed changes the largest, so the robot operation should pay special attention to the rotation of the joint 4. Figure 8 shows that the angular acceleration of each joint is not abrupt and the change is smooth. Therefore, it is known that the handling robot runs smoothly and meets the actual requirements.
Table 4. Handling robots each joint drive function
STEP(time,0.0,0.0,1.0,–33.034d)+STEP(time,1.0,0.0,3.0,0.0)+STEP(time,3.0,0.0,4.0,60.99d) +STEP(time,4.0,0.0,6.0,0.0)+STEP(time, 6.0, 0.0, 7.0, –37.956d)
+STEP(time,4.0,0.0,6.0,0.0)+STEP(time, 6.0, 0.0, 7.0, 41.618d)
+STEP(time,5.0,0.0,6.0,5.5d)+STEP(time, 6.0, 0.0, 7.0, -36.416d)
STEP(time, 0.0, 0.0,1.0,-180d)+STEP(time,1.0,0.0,6.0,0.0)
+STEP(time,5.0,0.0,6.0,-5.5d)+STEP(time, 6.0, 0.0d, 7.0, –40d)
+STEP(time, 6.0, 0.0d, 7.0, –17.956d)
Fig. 6. Handling the robot end space trajectory
Fig. 7. The speed of the joint rotation of the robot
Fig. 8. Handling the robot rotation angle of each joint rotation
In the automated production, the handling of industrial robots has become an indispensable tool, how effective and safe use of handling industrial robots has become a hot spot for continuous research. Using the multi-body dynamics simulation software ADAMS to simulate the movement process of the moving robot, it can not only get the corresponding speed and acceleration curve, so as to provide the basis for finding the problem and solving the problem, but also can see whether the robot has Interference and collision, reducing the physical prototype in the actual debugging damage, while saving time.
- Zhu Huabing, Zhang Juan, Song Xiaobing Kinematics analysis and simulation of industrial robot based on ADAMS. Mechanical Design and Manufacturing, Vol. 5, 2013, p. 204-206. [Search CrossRef]
- Wang Zhixing, Fan Wenxin, Zhang Baocheng, et al. Kinematics analysis and simulation of industrial robot based on Matlab. Journal of Mechanical and Electrical Engineering, Vol. 29, 2012, p. 33-37. [Search CrossRef]
- Yuan An, Xue Jinji Performance analysis and simulation of robot based on ADAMS. Manufacturing Automation, Vol. 33, 2011, p. 85-89. [Search CrossRef]
- Han Xing, Li Chang, Yu Xiaoguang, et al. Simulation and simulation analysis of arc – welding robot based on ADAMS/view. Transactions of the China Welding Institution, Vol. 34, 2013, p. 69-73. [Search CrossRef]
- Zeng Jian, Lin Yizhong, Liao Xiaoping, et al. Kinematics analysis and simulation of 6R spraying robot. Mechanical Design and Manufacturing, Vol. 6, 2010, p. 145-147. [Search CrossRef]
- Cai Zixing, Xie Bing Robotics. Third Ed. Tsinghua University Press, Beijing, 2015. [Search CrossRef]
- Guo Weidong Virtual Prototyping Technology and ADAMS Application Examples Tutorial. Beijing University of Aeronautics and Astronautics Press, Beijing, 2009. [Search CrossRef]
- Tao Qiming, Ke Zunzhong Research on new method of robot trajectory planning. Machine Tools and Hydraulic, Vol. 12, 2003, p. 24-26. [Search CrossRef]
- Guo Benyin, Liu Yu, Miao Liang Analysis of working space of six-DOF micro-parallel. Journal of Changchun University of Science and Technology. Vol. 38, 2015, p. 1-5. [Search CrossRef]
Mathematical Models in EngineeringHristijan Mickoski, Ivan Mickoski, Marjan Djidrov