Astesj 050340
Astesj 050340
Astesj 050340
3, 306-316 (2020)
ASTESJ
www.astesj.com
ISSN: 2415-6698
Special Issue on Multidisciplinary Sciences and Engineering
Department of Electronics and Communication Engineering, Amrita Vishwa Vidyapeetham, Amritapuri, 690525, India
www.astesj.com 310
R.K. Megalingam et al. / Advances in Science, Technology and Engineering Systems Journal Vol. 5, No. 3, 306-316 (2020)
𝐶𝐶𝐶𝐶𝐶𝐶(−𝜋𝜋/2) 0 𝑆𝑆𝑆𝑆𝑆𝑆(𝜋𝜋/2) 0
0 1 0 0
R_y= � � (17)
−𝑆𝑆𝑆𝑆𝑆𝑆(−𝜋𝜋/2) 0 𝐶𝐶𝐶𝐶𝐶𝐶(𝜋𝜋/2) 0
0 0 0 1
𝐶𝐶𝐶𝐶𝐶𝐶(𝜋𝜋) −𝑆𝑆𝑆𝑆𝑆𝑆(𝜋𝜋) 0 0
𝑆𝑆𝑆𝑆𝑆𝑆(𝜋𝜋) 𝐶𝐶𝐶𝐶𝐶𝐶(𝜋𝜋) 0 0
R_z= � � (18)
0 0 1 0
0 0 0 1
R_c = R_y*R_z (19)
4.5. Inverse kinematics (IK)
Figure 10: Cartesian representation of joints with rotational angles for DH- Inverse kinematics analysis is for obtaining the Joint angles by
parameters. using end effector Cartesian space or position coordinates. Since
the last three joints J4, J5, J6 in Figure5 and Figure 6 are revolute
𝑐𝑐𝜃𝜃𝑖𝑖 −𝑠𝑠𝜃𝜃𝑖𝑖 0 𝑎𝑎𝑖𝑖−1 joints with joint axis intersection at J5 which would be wrist
𝑠𝑠𝜃𝜃 𝑐𝑐𝑐𝑐 𝑐𝑐𝜃𝜃𝑖𝑖 𝑐𝑐𝛼𝛼𝑖𝑖−1 −𝑠𝑠𝛼𝛼𝑖𝑖−1 −𝑠𝑠𝛼𝛼𝑖𝑖−1 𝑑𝑑𝑖𝑖 center (WC). Thus the kinematic of the IK is now evaluated by
𝑇𝑇𝑖𝑖𝑖𝑖−1 = � 𝑖𝑖 𝑖𝑖−1 � (8)
𝑠𝑠𝜃𝜃𝑖𝑖 𝑠𝑠𝛼𝛼𝑖𝑖−1 𝑐𝑐𝜃𝜃𝑖𝑖 𝑠𝑠𝛼𝛼𝑖𝑖−1 𝑐𝑐𝛼𝛼𝑖𝑖−1 𝑐𝑐𝛼𝛼𝑖𝑖−1 𝑑𝑑𝑖𝑖 calculating Inverse position and Inverse Orientation.
0 0 0 1
4.5.1. Inverse Position
c𝜃𝜃𝑖𝑖 = cos 𝜃𝜃𝑖𝑖
The inverse position problem is for obtaining the first three joint
𝑠𝑠𝜃𝜃𝑖𝑖 = sin 𝜃𝜃𝑖𝑖 angles (𝜃𝜃1, 𝜃𝜃2, 𝜃𝜃3). To evaluate Inverse Position the end effector
c𝛼𝛼𝑖𝑖−1 = cos 𝛼𝛼𝑖𝑖−1 position (Px, Py, Pz) and Orientation (Roll, Pitch, Yaw) need to
be taken from the test case input data. Thus the rotation matrix for
𝑐𝑐𝜃𝜃1 −𝑠𝑠𝜃𝜃1 0 0 the end effector R_rpy shown (20). After the error correction the
𝑠𝑠𝜃𝜃 𝑐𝑐𝜃𝜃1 0 0 actual end effector rotation matrix R_end is given in (21). In (22)
𝑇𝑇01 = � 1 � (9)
0 0 1 0 ⋅ 15 the obtained matrix 𝑅𝑅06 is the rotation part of the full
0 0 0 1 homogeneous transform matrix𝑇𝑇0𝐸𝐸𝐸𝐸 which is a transform matrix
𝑐𝑐𝜃𝜃2 −𝑠𝑠𝜃𝜃2 0 0 of end effector to the base joint. Using these concepts the joint
0 0 1 0 ⋅ 14 angles (𝜃𝜃1, 𝜃𝜃2, 𝜃𝜃3) are obtained.
𝑇𝑇12 = � � (10)
−𝑠𝑠𝜃𝜃2 −𝑐𝑐𝜃𝜃2 0 0
0 0 0 1 R_rpy = Rot (Z, yaw)*Rot(Y, pitch)*Rot(X, Roll) (20)
Goal 1 0.301 0.651 0.525 1.2704 -0.9539 0.7554 -1.0660 1.3424 -1.185
Goal 2 0.402 0.730 0.376 1.0098 -1.222 0.9088 1.2786 0.476 1.4327
Goal 3 0.133 - 0.116 0.699 -0.5268 0.5868 -0.567 -0.6876 0.3067 0.0028
Goal 4 -0.392 0.532 0.825 2.2363 -0.6110 0.9545 0.043966 0.0151 0.6119
Goal 5 0.675 - 0.095 0.220 -0.0797 -1.0676 0.2312 -0.8217 0.4022 0.9090
Goal 6 - 0.019 0.242 1.020 1.4644 0.1755 0.3900 1.0424 0.5786 -1.297
Goal 7 0.204 0.644 0.529 1.3112 0.6556 0.3388 -0.9354 0.2892 1.14233
Goal 8 0.428 - 0.020 0.760 0 0 0 0 0 0
www.astesj.com 313
R.K. Megalingam et al. / Advances in Science, Technology and Engineering Systems Journal Vol. 5, No. 3, 306-316 (2020)
Goal 9 0.255 - 0.267 0.067 -0.89364 -1.23433 -0.70224 0.579329 0.924559 -0.41793
Goal 10 0.043 0.027 1.079 1.12537 0.424841 0.580440 -0.63930 0.2128 -0.99506
Goal11 - 0.017 - 0.110 0.759 1.396672 1.164312 -0.62972 0.222626 0.77854 0.505854
Goal 12 0.671 - 0.020 0.510 0.028259 -0.67949 0.223439 -0.42861 0.52486 0.095769
Goal 13 0.141 - 0.338 1.038 2.177904 0.639303 0.979159 1.05975 1.08808 -0.56990
Goal 14 0.281 - 0.123 0.844 2.831651 1.213924 -0.16744 0.57619 0.93674 -1.19414
Goal 15 0.303 - 0.716 0.108 -1.25223 -1.48647 0.71624 1.17593 0.725 -0.75893
Goal 16 -0.116 0.235 1.001 2.050420 0.0916879 0.3374000 0.156057999 1.03124 0.649038000
Table 4: Outcomes of the joint state values from the IK solver node in simulation for the user input coordinates using Keyboard.
Goal 1 0.301 0.651 0.525 1.2704 -0.9539 0.7554 -1.0660 1.3424 -1.185
Goal 2 0.402 0.730 0.376 1.0098 -1.222 0.9088 1.2786 0.476 1.4327
Goal 3 0.133 - 0.116 0.699 -0.5268 0.5868 -0.567 -0.6876 0.3067 0.0028
Goal 4 -0.392 0.532 0.825 2.2363 -0.6110 0.9545 0.043966 0.0151 0.6119
Goal 5 0.675 - 0.095 0.220 -0.0797 -1.0676 0.2312 -0.8217 0.4022 0.9090
Goal 6 - 0.019 0.242 1.020 1.4644 0.1755 0.3900 1.0424 0.5786 -1.297
Goal 7 0.204 0.644 0.529 1.3112 0.6556 0.3388 -0.9354 0.2892 1.14233
Goal 8 0.428 - 0.020 0.760 0 0 0 0 0 0
Goal 9 0.255 - 0.267 0.067 -0.89364 -1.23433 -0.70224 0.579329 0.924559 -0.41793
Goal 10 0.043 0.027 1.079 1.12537 0.424841 0.580440 -0.63930 0.2128 -0.99506
Goal 11 - 0.017 - 0.110 0.759 1.396672 1.164312 -0.62972 0.222626 0.77854 0.505854
Goal 12 0.671 - 0.020 0.510 0.028259 -0.67949 0.223439 -0.42861 0.52486 0.095769
Goal 13 0.141 - 0.338 1.038 2.177904 0.639303 0.979159 1.05975 1.08808 -0.56990
Goal14 0.281 - 0.123 0.844 2.831651 1.213924 -0.16744 0.57619 0.93674 -1.19414
Goal 15 0.303 - 0.716 0.108 -1.25223 -1.48647 0.71624 1.17593 0.725 -0.75893
Goal16 -0.116 0.235 1.001 2.050420 0.0916879 0.3374000 0.156057999 1.03124 0.649038000
Table 5: Outcomes of the joint state values from the IK solver node in simulation for the user input coordinates using Joystick.
Goal Count X position Y position Z position DOF1 DOF2 DOF3 DOF4 DOF5 DOF6
(radians) (radians) (radians) (radians) (radians) (radians)
Goal 1 0.305 0.652 0.525 1.2704 -0.9540 0.7556 -1.0660 1.3424 -1.185
Goal 2 0.406 0.7304 0.376 1.0098 -1.230 0.9089 1.2786 0.476 1.4327
Goal 3 0.135 - 0.116 0.699 -0.5268 0.5871 -0.567 -0.6876 0.3067 0.0028
Goal 4 -0.394 0.530 0.825 2.2363 -0.6116 0.9548 0.043966 0.0151 0.6119
Goal 5 0.67 - 0.095 0.220 -0.0797 -1.0681 0.2312 -0.8217 0.4022 0.9090
Goal 6 - 0.015 0.242 1.020 1.4644 0.1755 0.3900 1.0424 0.5786 -1.297
Goal 7 0.209 0.645 0.529 1.3112 0.6558 0.3389 -0.9354 0.2892 1.14233
Goal 8 0.421 - 0.020 0.760 0 0 0 0 0 0
Goal 9 0.255 - 0.267 0.067 -0.89364 -1.23433 -0.70224 0.579329 0.924559 -0.41793
Goal 10 0.043 0.028 1.079 1.12537 0.424841 0.58048 -0.63930 0.2128 -0.99506
Goal11 - 0.017 - 0.110 0.759 1.396672 1.164312 -0.62972 0.222626 0.77854 0.505854
Goal 12 0.671 - 0.020 0.510 0.028259 -0.67949 0.223439 -0.42861 0.52486 0.095769
Goal 13 0.141 - 0.338 1.038 2.177904 0.639303 0.979159 1.05975 1.08808 -0.56990
Goal14 0.281 - 0.123 0.844 2.831651 1.213924 -0.16744 0.57619 0.93674 -1.19414
Goal 15 0.303 - 0.716 0.108 -1.25223 -1.48647 0.71624 1.17593 0.725 -0.75893
Goal16 -0.116 0.234 1.001 2.050420 0.0916879 0.3375 0.156057999 1.03124 0.649038000
www.astesj.com 314
R.K. Megalingam et al. / Advances in Science, Technology and Engineering Systems Journal Vol. 5, No. 3, 306-316 (2020)
Table 6: Outcomes of the joint state values from the IK solver node on hardware testing for the user input coordinates using GUI
Goal 1 0.301 0.651 0.525 1.2799 -0.9538 0.7600 -1.0659 1.3426 -1.184
Goal 2 0.402 0.730 0.376 1.0095 -1.222 0.9086 1.2786 0.480 1.4327
Goal 3 0.133 - 0.116 0.699 -0.5268 0.5868 -0.567 -0.6876 0.3067 0.0028
Goal 4 -0.392 0.532 0.825 2.2363 -0.611015 0.95467 0.0439666 0.01561 0.6119
Goal 5 0.675 - 0.095 0.220 -0.07978 -1.0676 0.2312 -0.82172 0.4022 0.9090
Goal 6 - 0.019 0.242 1.020 1.464454 0.1755 0.3900 1.0424 0.57862 -1.29711
Goal 7 0.204 0.644 0.529 1.3112 0.6556 0.3388 -0.9354 0.2892 1.14233
Goal 8 0.428 - 0.020 0.760 0 0. 0 0 0 0
Goal 9 0.255 - 0.267 0.067 -0.89364 -1.234335 -0.702246 0.579329 0.924559 -0.41793
Goal 10 0.043 0.027 1.079 1.12537 0.424841 0.5804405 -0.63930 0.21285 -0.99506
Goal11 - 0.017 - 0.110 0.759 1.3966725 1.1643121 -0.629728 0.2226262 0.77854 0.505854
Goal 12 0.671 - 0.020 0.510 0.028259 -0.67949 0.223439 -0.42861 0.52486 0.095769
Goal 13 0.141 - 0.338 1.038 2.177904 0.639303 0.97915954 1.0597566 1.088084 -0.56990
Goal14 0.281 - 0.123 0.844 2.831651 1.2139244 -0.16744 0.576198 0.93674 -1.19414584
Goal 15 0.303 - 0.716 0.108 -1.252234 -1.48647 0.7162445 1.175932 0.72512 -0.75893
Goal 16 -0.116 0.235 1.001 2.050420 0.0916879 0.3374000 0.156057999 1.03124 0.649038000
6. Conclusion [1] Megalingam R.K, Sivanantham V, Kumar K.S, Ghanta S, Teja P.S,
Gangireddy R, Sakti Prasad K.M, Gedela V.V, “Design and development of
inverse kinematic based 6 DOF robotic arm using ROS”, International Journal
In this research work, the authors proposed and evaluated of Pure and Applied Mathematics, 118, pp. 2597-2603, ISSN: 1314-3395
reliable methods for controlling a robotic arm by testing it in both [2] Xinquan Liang, Haris Cheong, Yi Sun, Jin Guo, Chee Kong Chui, Chen-Hua
hardware and simulation using RVIZ. The authors in [17] used Yeo, “Design, Characterization, and Implementation of a Two-DOF Fabric-
the MoveIt to build a kinematics library for the IK of the robotic Based Soft Robotic Arm”, IEEE Robotics and Automation
letters(Volume:3,Issue:3,July2018),https://doi.org/10.1109/LRA.2018.28317
arm, but as an extension of that, this research designed and 23
developed a kinematics-based solution using DH parameters [3] Asghar Khan, Wang Li Quan. “Structure design and workspace calculation of
method. Using the derived equations, successfully tested the 6-DOF underwater manipulator”. 2017 14th International Bhurban
Conference on Applied Sciences and Technology (IBCAST), 10-14 Jan 2014,
designed robotic arm in Rviz using the proposed control https://doi.org/ 10.1109/IBCAST.2017.7868119
mechanisms. A survey is conducted in evaluating the best control [4] Elkin Yesid Veslin; Max Suell Dutra; Omar Lengerke; Edith Alejandra
methodology where Figure [12] and Figure [13] depict the results. Carreño; Magda Judith Morales, “A Hybrid Solution for the Inverse
Kinematic on a Seven DOF Robotic Manipulator”, IEEE Latin America
Based on the survey, the research validates that the joystick failed Transactions ( Volume: 12, Issue: 2, March 2014 ), https://doi.org/
in achieving the desired input coordinate positions due to 10.1109/TLA.2014.6749540
signaling and hardware issues. But GUI and Keyboard showed [5] Pietro Falco; Ciro Natal, “On the Stability of Closed-Loop Inverse
Kinematics Algorithms for Redundant Robots”, 05 May 2011, IEEE
better results in controlling the arm. Transactions on Robotics (Volume: 27, Issue: 4, Aug. 2011 ),https://doi.org/
As a rule, simulations do not reproduce the exact real-time 10.1109/TRO.2011.2135210
behavior of an entity or a system. PID based control can reduce [6] Seo-Wook Park, Jun-Ho Oh, “Hardware Realization of Inverse Kinematics
for Robot Manipulators”, IEEE Transactions on Industrial Electronics Vol.41,
the error. The research can be enhanced by testing the proposed No 1, February 1994, https://doi.org/ 10.1109/41.281607
design in the Gazebo simulation software. Gazebo provides the [7] Rajesh Kannan Megalingam, Nigam Katta, Raviteja Geesala, Prasant Kumar
Yadav, “Keyboard Based Control and Simulation of 6 DOF Robotic Arm
flexibility to use a PID-based controller, which helps in smooth using ROS”, 2018 4th International Conference on Computing
and exact mimicking of the real-time robotic arm as per Communication and Automation(ICCCA),
simulation in RVIZ. The proposed testing gives the developer https://doi.org/10.1109/CCAA.2018.8777568
[8] Wei Qian, Ziyang Xia, Jing Xiong, Yangzhou Gan, Yangchow Guo, Shaokui
good results. Design of the end effector can be improved for Weng, Hao Deng, Ying Hu, Jiawei Zhang, “Manipulation Task simulation
performance of multiple, divergent tasks in a real time using ROS and Gazebo”, Robotics and Biomimetics (ROBIO), 2014 IEEE
International Conference”, https://doi.org/10.1109/ROBIO.2014.7090732
environment. The singularity issues can be reduced for better [9] Žlajpah Leon, Simulation in robotics (2008) Mathematics and Computers in
performance and enhancement of the task. Simulation, 79 (4), 15 December 2008, pp. 879-897,
https://doi.org/10.1016/j.matcom.2008.02.017
Acknowledgment [10] Kichang Lee ; Jiyoung Lee ; Bungchul Woo ; Jeongwook Lee ; Young-Jin
Lee, Kimhae-si ; Syungkwon Ra “Modeling and Control of an Articulated
Robot Arm with Embedded Joint Actuators ”,2018 International Conference
We are grateful for Amrita Vishwa Vidyapeetham and on Information and Communication Technology Robotics (ICT-ROBOT),
Humanitarian and Technology Labs for providing us with all the https://doi.org/10.1109/ICT-ROBOT.2018.8549903
[11] Alla N Barakat, Khaled A. Gouda, Kenza.Bozed, “ Kinematics analysis and
sophisticated requirements to develop and complete this paper. simulation of a robotic arm using MATLAB”,2016 4th International
Conference on Control Engineering & Information Technology (CEIT),16-18
References Dec. 2016, Hammamet, Tunisia, https://doi.org/
10.1109/CEIT.2016.7929032
www.astesj.com 315
R.K. Megalingam et al. / Advances in Science, Technology and Engineering Systems Journal Vol. 5, No. 3, 306-316 (2020)
[12] Stefano Carpin, Mike Lewis, Jijun Wang, “USARSim: a robot simulator for
research and education” Proceedings 2007 IEEE International Conference on
Robotics and Automation, 10-14 April 2007, Roma Italy, https://doi.org/
10.1109/ROBOT.2007.363180
[13] ] Jun-Di Sun; Guang-Zhong Cao; Wen-Bo Li; Yu-Xin Liang; Su-Dan Huang,
“Analytical inverse kinematic solution using the D-H method for a 6-DOF
robot”, 2017 14th International Conference on Ubiquitous Robots and
Ambient Intelligence (URAI), https://doi.org/10.1109/URAI.2017.7992807
[14] Akhilesh Kumar Mishra; Oscar Meruvia-Pastor; “ Robot arm manipulation
using depth-sensing cameras and inverse kinematics ”2014 Oceans-St
John’s,14-19 September 2014 IEEE International Conference, St. John's, NL,
Canada, https://doi.org/ 10.1109/OCEANS.2014.7003029
[15] C. A. G. Gutiérrez; J. R. Reséndiz; J. D. M. Santibáñez; G. M. Bobadilla, “A
Model and Simulation of a Five-Degree-of-Freedom Robotic Arm for
Mechatronic Courses”, IEEE Latin America Transactions ( Volume: 12,
Issue: 2, March 2014 ) ,https://doi.org/ 10.1109/TLA.2014.6749521
[16] Zenghua Bian ; Zhengmao Ye ; Weilei Mu,” Kinematic analysis and
simulation of 6-DOF industrial robot capable of picking up die-casting
products”, 2016 IEEE International Conference on Aircraft Utility Systems
(AUS), https://doi.org/ 10.1109/AUS.2016.7748017
[17] S. Hernandez-Mendez, C. Maldonado-Mendez, A. Marin-Hernandez, H. V.
Rios-Figureueroa, H. Vazquez-Leal and E. R. Palacios-Hernandez, “Design
and implementation of a robotic arm using ROS and MoveIt!”, 2017 IEEE
International Autumn Meeting on Power, Electronics and Computing
(ROPEC), Ixtapa, 2017, pp. 1-6, http://doi.org/
10.1109/ROPEC.2017.8261666
[18] Weimin Shen, Jason Gu, Yide Ma, “3D Kinematic Simulation for PA10-7C
Robot Arm Based on VRML”, 18-21 Aug. 2007, Jinan, China.
https://doi.org/10.1109/ICAL.2007.4338637
[19] José de Jesús Rubio, “Sliding mode control of robotic arms with dead zone”,
IET Control Theory & Applications (Volume: 11, Issue: 8, 5 12 2017),
https://doi.org/ 10.1049/iet-cta.2016.0306
[20] Megalingam R.K, Rajesh Gangireddy, Gone Sriteja, Ashwin Kashyap,
Apuroop Sai Ganesh “Adding intelligence to the robotic coconut tree climber”
2017 International Conference on Inventive Computing and Informatics
(ICICI), 23-24 Nov. 2017, Coimbatore India, https://doi.org/
10.1109/ICICI.2017.8365206
[21] Teerawat Thepmanee, Jettiya Sripituk, Prapart Ukakimapurn, “A simple
technique to modeling and simulation four-axe robot-arm control” 17-20 Oct.
2007, Coex, Seoul, Korea, https://doi.org/10.1109/ICCAS.2007.4406694
[22] Tingting Meng; Wei He, “Iterative Learning Control of a Robotic Arm
Experiment Platform with Input Constraint”, IEEE Transactions on Industrial
Electronics (Volume: 65, Issue: 1, Jan. 2018), https://doi.org/
10.1109/TIE.2017.2719598
[23] Gourab Sen Gupta, Subhas Chandra Mukhopadhyay, Christopher H.
Messom, Serge N. Demidenko, “Master-Slave Control of a Teleoperated
Anthropomorphic Robotic Arm With Gripping Force Sensing ”, IEEE
Transactions on Instrumentation and Measurement ( Volume: 55, Issue: 6,
Dec. 2006 ),https://doi.org/ 10.1109/TIM.2006.884393
[24] P. Lucibello,“ Repositioning control of robotic arms by learning ”, IEEE
Transactions on Automatic Control ( Volume: 39, Issue: 8, Aug 1994 ),
https://doi.org/ 10.1109/9.310053
[25] Qingyuan Sun; Lingcheng Kong; Zhihua Zhang; Tao Mei, “Design of
wireless sensor network node monitoring interface based on Qt”, 2010
International Conference on Future Information Technology and
Management Engineering, Changzhou, 2010, pp. 127-130
[26] R. Takuma; Y. Asahara ; H. Kajimoto ; N. Kawakami ; S. Tachi,
“Development of anthropomorphic multi-D.O.F master-slave arm for mutual
telexistence ”, IEEE Transactions on Visualization and Computer Graphics (
Volume: 11 , Issue: 6 , Nov.-Dec. 2005 ), https://doi.org/
10.1109/TVCG.2005.99
[27] Ramesh, S. B. Hussain and F. Kangal, "Design of a 3 DOF robotic arm," 2016
Sixth International Conference on Innovative Computing Technology
(INTECH), Dublin, 2016, pp. 145-149, https://doi.org/
10.1109/INTECH.2016.7845007
[28] Jose de Jesus Rubio; Adrian Gustavo Bravo; Jaime Pacheco; Carlos
Aguilar,“Passivity analysis and modeling of robotic arms”, IEEE Latin
America Transactions ( Volume: 12 , Issue: 8 , Dec. 2014 ) ,https://doi.org/
10.1109/TLA.2014.7014505
www.astesj.com 316