inverse kinematics analysis trajectory planning for a robot arm
DESCRIPTION
INVERSE KINEMATICS ANALYSIS TRAJECTORY PLANNING FOR A ROBOT ARM. Adviser : Ming-Yuan Shieh Student ID : M9920105 Student : Chun-Ming Su. Proceedings of 2011 8th Asian Control Conference Kaohsiung, Taiwan, May 15-18, 2011 - PowerPoint PPT PresentationTRANSCRIPT
![Page 1: INVERSE KINEMATICS ANALYSIS TRAJECTORY PLANNING FOR A ROBOT ARM](https://reader030.vdocuments.site/reader030/viewer/2022012904/56815d94550346895dcbb046/html5/thumbnails/1.jpg)
INVERSE KINEMATICS ANALYSIS TRAJECTORY PLANNING FORA ROBOT ARMProceedings of 2011 8th Asian Control Conference Kaohsiung, Taiwan, May 15-18, 2011Guo-Shing Huang, Chiou-Kou Tung, Hsiung-Cheng Lin, and Shun-Hui HsiaoDepartment of Electronic Engineering, National Chin-Yi University of TechnologyTaichung 41101, Taiwan, ROC
Adviser : Ming-Yuan ShiehStudent ID : M9920105Student : Chun-Ming Su
1
![Page 2: INVERSE KINEMATICS ANALYSIS TRAJECTORY PLANNING FOR A ROBOT ARM](https://reader030.vdocuments.site/reader030/viewer/2022012904/56815d94550346895dcbb046/html5/thumbnails/2.jpg)
OUTLINE Abstract Introduction Structure of the 6-DOF humanoid robot arm
A. Hardware descriptionB. Structure of the 6-DOF humanoid robot arm
Kinematics of the humanoid robot armA. Forward kinematicsB. Inverse kinematics
Simulation results Conclusion
2
![Page 3: INVERSE KINEMATICS ANALYSIS TRAJECTORY PLANNING FOR A ROBOT ARM](https://reader030.vdocuments.site/reader030/viewer/2022012904/56815d94550346895dcbb046/html5/thumbnails/3.jpg)
ABSTRACT This paper presents a 6-DOF robot arm system.
Using the robot arm assembled by seven AI servos (RX-64), set up robot‘s coordinate system with the D-H notation method.
To adjust and drive the robot arm to the coordinates of folder and place between ones and the target object, make the angle of the shaft position can accurately locate the direction for all axes of the robot arm and obtain the optimal motion path. 3
![Page 4: INVERSE KINEMATICS ANALYSIS TRAJECTORY PLANNING FOR A ROBOT ARM](https://reader030.vdocuments.site/reader030/viewer/2022012904/56815d94550346895dcbb046/html5/thumbnails/4.jpg)
Under the experimental test, we position the object using the camera which was installed on robot arm, according to the attitude of the object, control the robot arm through the analysis result of inverse kinematics equation in order to make the robot arm achieve the action of exact grasping object.
Finally, the robot arm system will be used on the meal service robot to serve for guests.
4
![Page 5: INVERSE KINEMATICS ANALYSIS TRAJECTORY PLANNING FOR A ROBOT ARM](https://reader030.vdocuments.site/reader030/viewer/2022012904/56815d94550346895dcbb046/html5/thumbnails/5.jpg)
INTRODUCTION The robot arm system is widely used in
production, processing, product transportation, domestic services and other fields.
But the robot arm which is fixed on the platform, its work space is very limited.
In addition, the motion path of a pairs of moving robot arm makes the analysis more complex using inverse kinematics, all these questions are concerned by a lot of experts of the robot field. 5
![Page 6: INVERSE KINEMATICS ANALYSIS TRAJECTORY PLANNING FOR A ROBOT ARM](https://reader030.vdocuments.site/reader030/viewer/2022012904/56815d94550346895dcbb046/html5/thumbnails/6.jpg)
This paper proposes a method to solve the inverse kinematics for the robot arm which makes up with six-degree-of-freedom joints in order to analyze the inverse kinematics of the robot arm, can find the end-effector position and posture of the robot arm that can meet the qualification in the workspace, and then realize the operation to reach the target.
The experimental results verify that the proposed inverse kinematics analysis approach in this paper has the higher accuracy. 6
![Page 7: INVERSE KINEMATICS ANALYSIS TRAJECTORY PLANNING FOR A ROBOT ARM](https://reader030.vdocuments.site/reader030/viewer/2022012904/56815d94550346895dcbb046/html5/thumbnails/7.jpg)
STRUCTURE OF THE 6-DOF HUMANOID ROBOT ARM This section describes in more detail the
main hardware structure and system structure that were adopted in this work.
A. Hardware description
B. Structure of the 6-DOF humanoid robot arm
7
![Page 8: INVERSE KINEMATICS ANALYSIS TRAJECTORY PLANNING FOR A ROBOT ARM](https://reader030.vdocuments.site/reader030/viewer/2022012904/56815d94550346895dcbb046/html5/thumbnails/8.jpg)
A. HARDWARE DESCRIPTION In this paper, the embedded computer is as
the main controller, adopt Dynamixel RX-64 servo motor which is produced by ROBOTIS Company as the main motive force of the robot arm, as shown in Fig. 1.
(a) (b)
Figure 1. (a) Dynamixel RX-64 servo motor. (b) Robot arm.
8
![Page 9: INVERSE KINEMATICS ANALYSIS TRAJECTORY PLANNING FOR A ROBOT ARM](https://reader030.vdocuments.site/reader030/viewer/2022012904/56815d94550346895dcbb046/html5/thumbnails/9.jpg)
The system structure is shown in Fig. 2.
9
![Page 10: INVERSE KINEMATICS ANALYSIS TRAJECTORY PLANNING FOR A ROBOT ARM](https://reader030.vdocuments.site/reader030/viewer/2022012904/56815d94550346895dcbb046/html5/thumbnails/10.jpg)
B. STRUCTURE OF THE 6-DOF HUMANOID ROBOT ARM The robot arm comprises shoulder joint,
upper arm, elbow joint, lower arm, wrist and the end-effecter. The robot arm has six degrees of freedom, three degrees of freedom are located at the shoulder, the elbow has two degrees of freedom, and one degree of freedom is assigned on the wrist.
10
![Page 11: INVERSE KINEMATICS ANALYSIS TRAJECTORY PLANNING FOR A ROBOT ARM](https://reader030.vdocuments.site/reader030/viewer/2022012904/56815d94550346895dcbb046/html5/thumbnails/11.jpg)
Fig. 3 shows the structure diagram of the right robot arm.
11
![Page 12: INVERSE KINEMATICS ANALYSIS TRAJECTORY PLANNING FOR A ROBOT ARM](https://reader030.vdocuments.site/reader030/viewer/2022012904/56815d94550346895dcbb046/html5/thumbnails/12.jpg)
KINEMATICS OF THE HUMANOID ROBOT ARM A D-H coordinate system of the humanoid
robot arm is found in Fig 4. The parameters of link are shown in Table I.
12
![Page 13: INVERSE KINEMATICS ANALYSIS TRAJECTORY PLANNING FOR A ROBOT ARM](https://reader030.vdocuments.site/reader030/viewer/2022012904/56815d94550346895dcbb046/html5/thumbnails/13.jpg)
13
![Page 14: INVERSE KINEMATICS ANALYSIS TRAJECTORY PLANNING FOR A ROBOT ARM](https://reader030.vdocuments.site/reader030/viewer/2022012904/56815d94550346895dcbb046/html5/thumbnails/14.jpg)
According to D-H coordinate system, the homogeneous trans-formation matrix i T (i = 1,2,...,6) expresses
14
![Page 15: INVERSE KINEMATICS ANALYSIS TRAJECTORY PLANNING FOR A ROBOT ARM](https://reader030.vdocuments.site/reader030/viewer/2022012904/56815d94550346895dcbb046/html5/thumbnails/15.jpg)
A. FORWARD KINEMATICS Institute the link parameters from Table I into
(1), the pose of end-effector can be obtained
15
![Page 16: INVERSE KINEMATICS ANALYSIS TRAJECTORY PLANNING FOR A ROBOT ARM](https://reader030.vdocuments.site/reader030/viewer/2022012904/56815d94550346895dcbb046/html5/thumbnails/16.jpg)
B. INVERSE KINEMATICS In finding out solution of the inverse
kinematics, using the obtained homogeneous transform matrix of robot arm, to the formula of homogeneous transform matrix of the fix target coordinate in (2), multiples inverse matrix in (3), the inverse kinematics is derived by using to compare with every element of two matrices.
16
![Page 17: INVERSE KINEMATICS ANALYSIS TRAJECTORY PLANNING FOR A ROBOT ARM](https://reader030.vdocuments.site/reader030/viewer/2022012904/56815d94550346895dcbb046/html5/thumbnails/17.jpg)
Let elements (1, 4), (2, 4), (3, 4) of both sides in (3) be equal respectively, add the above three equations after them to be squared.
where
17
![Page 18: INVERSE KINEMATICS ANALYSIS TRAJECTORY PLANNING FOR A ROBOT ARM](https://reader030.vdocuments.site/reader030/viewer/2022012904/56815d94550346895dcbb046/html5/thumbnails/18.jpg)
Since ∈ (−180°~ −70°) , we have
where Atan 2(⋅) is the four quadrant arctangent function.
According to the orthogonality of rotation matrix, elements of homogenous matrix described in (2) satisfy following equations:
18
![Page 19: INVERSE KINEMATICS ANALYSIS TRAJECTORY PLANNING FOR A ROBOT ARM](https://reader030.vdocuments.site/reader030/viewer/2022012904/56815d94550346895dcbb046/html5/thumbnails/19.jpg)
In (2), we get
Let elements (1, 4), (2, 4), (3, 4) of both sides in (8) be equal respectively, we have
19
![Page 20: INVERSE KINEMATICS ANALYSIS TRAJECTORY PLANNING FOR A ROBOT ARM](https://reader030.vdocuments.site/reader030/viewer/2022012904/56815d94550346895dcbb046/html5/thumbnails/20.jpg)
Add the above three equations after them to be squared, and follow up (7), we obtain the solution of
where
20
![Page 21: INVERSE KINEMATICS ANALYSIS TRAJECTORY PLANNING FOR A ROBOT ARM](https://reader030.vdocuments.site/reader030/viewer/2022012904/56815d94550346895dcbb046/html5/thumbnails/21.jpg)
In (9), let
Since ∈ (−180°~ −70°) , we obtain the solution of ,
21
![Page 22: INVERSE KINEMATICS ANALYSIS TRAJECTORY PLANNING FOR A ROBOT ARM](https://reader030.vdocuments.site/reader030/viewer/2022012904/56815d94550346895dcbb046/html5/thumbnails/22.jpg)
Then the solution of is
Where sign(⋅) is the sign function, it is defined as
We rearrange (2) and get22
![Page 23: INVERSE KINEMATICS ANALYSIS TRAJECTORY PLANNING FOR A ROBOT ARM](https://reader030.vdocuments.site/reader030/viewer/2022012904/56815d94550346895dcbb046/html5/thumbnails/23.jpg)
Let element of both sides in (14) be equal, we get
23
![Page 24: INVERSE KINEMATICS ANALYSIS TRAJECTORY PLANNING FOR A ROBOT ARM](https://reader030.vdocuments.site/reader030/viewer/2022012904/56815d94550346895dcbb046/html5/thumbnails/24.jpg)
Let
24
![Page 25: INVERSE KINEMATICS ANALYSIS TRAJECTORY PLANNING FOR A ROBOT ARM](https://reader030.vdocuments.site/reader030/viewer/2022012904/56815d94550346895dcbb046/html5/thumbnails/25.jpg)
Since ∈( −180°~ −70°) , we can obtain the solutions of and .
It is obvious that there are two groups of results to guarantee a small variable, we should choose one group according to “the shortest route”.
25
![Page 26: INVERSE KINEMATICS ANALYSIS TRAJECTORY PLANNING FOR A ROBOT ARM](https://reader030.vdocuments.site/reader030/viewer/2022012904/56815d94550346895dcbb046/html5/thumbnails/26.jpg)
SIMULATION RESULTS
26Figure 5. Initialized position of end-effector.
![Page 27: INVERSE KINEMATICS ANALYSIS TRAJECTORY PLANNING FOR A ROBOT ARM](https://reader030.vdocuments.site/reader030/viewer/2022012904/56815d94550346895dcbb046/html5/thumbnails/27.jpg)
27Figure 6. Moved position of end-effector.
![Page 28: INVERSE KINEMATICS ANALYSIS TRAJECTORY PLANNING FOR A ROBOT ARM](https://reader030.vdocuments.site/reader030/viewer/2022012904/56815d94550346895dcbb046/html5/thumbnails/28.jpg)
In experiments, we used the cine camera that fixed on robot to confirm the goal position of object as the vision orientation method.
Then, robot picked up the goal object through the robot arm.
28
![Page 29: INVERSE KINEMATICS ANALYSIS TRAJECTORY PLANNING FOR A ROBOT ARM](https://reader030.vdocuments.site/reader030/viewer/2022012904/56815d94550346895dcbb046/html5/thumbnails/29.jpg)
29
![Page 30: INVERSE KINEMATICS ANALYSIS TRAJECTORY PLANNING FOR A ROBOT ARM](https://reader030.vdocuments.site/reader030/viewer/2022012904/56815d94550346895dcbb046/html5/thumbnails/30.jpg)
CONCLUSION In this paper, the kinematics of the six-
degree-of-freedom robot arm of humanoid robot was analyzed.
The proposed method can obtain the kinematics equation at the same time with the geometric structure and the homogeneous transformation matrix to control the robot arm.
30
![Page 31: INVERSE KINEMATICS ANALYSIS TRAJECTORY PLANNING FOR A ROBOT ARM](https://reader030.vdocuments.site/reader030/viewer/2022012904/56815d94550346895dcbb046/html5/thumbnails/31.jpg)
Finally, the paper presents the robot arm successfully pick-ups the goal (a bottle) utilizing Matlab Software to imitate the kinematics data and actual experiments.
The experimental result verifies the validity of the kinematics equation.
Next work, the robot arm system will apply to the order meal service robot, can be used for guest to receive, wait, order, check out, see a visitor out,… and so on in every restaurants or hotels in the early future.
31