Forward and Inverse Kinematics Analysis of Denso Robot

Total Page:16

File Type:pdf, Size:1020Kb

Forward and Inverse Kinematics Analysis of Denso Robot Proceedings of the International Symposium of Mechanism and Machine Science, 2017 AzC IFToMM – Azerbaijan Technical University 11-14 September 2017, Baku, Azerbaijan Forward and Inverse Kinematics Analysis of Denso Robot Mehmet Erkan KÜTÜK 1*, Memik Taylan DAŞ2, Lale Canan DÜLGER1 1*Mechanical Engineering Department, University of Gaziantep Gaziantep/ Turkey E-mail: [email protected] 2 Mechanical Engineering Department, University of Kırıkkale Abstract used Robotic Toolbox in forward kinematics analysis of A forward and inverse kinematic analysis of 6 axis an industrial robot [4]. DENSO robot with closed form solution is performed in This study includes kinematics of robot arm which is this paper. Robotics toolbox provides a great simplicity to available Gaziantep University, Mechanical Engineering us dealing with kinematics of robots with the ready Department, Mechatronics Lab. Forward and Inverse functions on it. However, making calculations in kinematics analysis are performed. Robotics Toolbox is traditional way is important to dominate the kinematics also applied to model Denso robot system. A GUI is built which is one of the main topics of robotics. Robotic for practical use of robotic system. toolbox in Matlab® is used to model Denso robot system. GUI studies including Robotic Toolbox are given with 2. Robot Arm Kinematics simulation examples. Keywords: Robot Kinematics, Simulation, Denso The robot kinematics can be categorized into two Robot, Robotic Toolbox, GUI main parts; forward and inverse kinematics. Forward kinematics problem is not difficult to perform and there is no complexity in deriving the equations in contrast to the 1. Introduction inverse kinematics. Especially nonlinear equations make the inverse kinematics problem complex. They may also Robot kinematics specifies the analytical study of the be coupled and have not got unique solutions. Thus motion of a robot manipulator. Formulating the reasonable solutions obtained mathematically may not solve the kinematics models for a robot mechanism is very problem physically [5]. Liu et al. applied geometric important in order to investigate the behaviour of approach for inverse kinematics analysis of a 6 dof robot industrial manipulators. There are two different spaces [6]. Qiao et al. used double quaternions to get solution for used in kinematics modelling of manipulators. They are inverse kinematics problem [7]. Nubiola and Bonev called Cartesian space and Quaternion space. The offered a simple and efficient way to solve inverse transformation between two Cartesian coordinate systems kinematics problem for 6R robots [8]. It is noticed that, can be decayed into a rotation and a translation. There are Artificial Intelligence (AI) methods are frequently used in a lot of approaches to represent rotation like Euler angles, inverse kinematics problem [9, 10, 11] in recent years. Gibbs vector, Cayley-Klein parameters, orthonormal matrices etc. Homogenous transformations based on 4x4 2.1 Forward Kinematics Analysis real matrices have been used dominantly in robotics [1]. Robotics Toolbox contains a lot of functions that are The forward kinematics problem is related between demanded in robotics and addresses fields such as the individual joints of the robot manipulator and the kinematics, dynamics, and trajectory generation. The position and orientation of the tool or end-effector. The Toolbox is convenient for simulation besides analyzing joint variables are the angles between the links for results from experiments with real robots. It is also an revolute or prismatic joints, and the link extension in the effective tool for education. The Toolbox is organized on prismatic or sliding joints [12]. A systematic way of a very common method of representing the kinematics and describing the geometry of a serial chain of links and dynamics of serial-link manipulators. It is described by joints was proposed by Denavit and Hartenberg and is the matrices. These include, in the basic case, the Denavit known today as Denavit-Hartenberg (DH) notation [2]. and Hartenberg parameters of the robot [2]. Any serial- The matrix A representing four movements is found by link manipulator can be configured by the user. A number postmultiplying the four matrices giving four movements of examples are provided for well-known robots such as to reach frame {j-1} to frame {j} in Figure 1. the Puma 560 and the Stanford arm [3]. Constantin et al. 71 Proceedings of the International Symposium of Mechanism and Machine Science, 2017 AzC IFToMM – Azerbaijan Technical University 11-14 September 2017, Baku, Azerbaijan The following table shows DH parameters of the Denso robotic arm necessary to derive the kinematics of the robot. Gripper is not included in the analysis. Table 1. DH Parameters of the Denso Robotic Arm Joint Limits Joint i i di ai i (degrees) 1 q1 d1 0 /2 160, 160 q 120, 120 Fig. 1. DH representation of a general purpose joint-link 2 2 0 a2 0 combination q Transformation between two joints in a generic form [3] is 3 3 0 a3 /2 20, 160 given in Eq. (1). 4 q4 d4 0 cosj sin j cos j sin j sin ja j cos j sin cos cos cos sin a sin 5 q5 0 0 j1 j j j j j j j (1) Aj 0 sinj cos jd j 6 q6 d6 0 0 360, 360 0 0 0 1 where = 0.125m, a2 =0.21m, a3 =-0.075m, = 0.21m Denso Robot is a 6 Degrees-of-Freedom (DOF) robotic and = 0.07m. manipulator. The link lengths are given in Figure 2(a). World frame and joint frames used in calculations and Transformation matrix for each joint can be obtained home position of Denso robot are shown in Figure 2b and by using Eq. (1). The parameters given in Table 1 are Figure 2c, respectively. substituted into Eq. (1) to find each of them. Six transformation matrices are presented in Eq. (2). CS1100 C2 S 20 a 2 C 2 SC00 S C0 a S 11 2 2 2 2 A1 A 2 0 1 0 d 0 0 1 0 1 0 0 0 1 0 0 0 1 CS00 C0 S a C 44 3 3 3 3 SC4400 S30 C 3 a 3 S 3 A4 A3 0 1 0 0 0 1 0 d4 0 0 0 1 0 0 0 1 CS00 (a) Link lengths (b) World frame and joint frames 55 CS 00 66 SC5500 SC6600 A5 A 0 1 0 0 6 0 0 1 d6 0 0 0 1 0 0 0 1 (2) where Cos and Sin are abbreviated to C and S, respectively. The total transformation between the base of the robot and the hand is; R (c) Home position TAAAAAAH 1 2 3 4 5 6 (3) Fig.2. General overview of DENSO 72 Proceedings of the International Symposium of Mechanism and Machine Science, 2017 AzC IFToMM – Azerbaijan Technical University 11-14 September 2017, Baku, Azerbaijan Transformation matrices for six axes given in Eq. (2) are To find the inverse kinematics solution for the 1st joint th postmultiplied in an order which is given in Eq. (3). This 1 as a function of the known elements, the 6 link equality is shown in Eq. (4). transformation inverse is postmultiplied as follows in Eq. nx o x a x P x (9). n o a P (4) y y y y nx o x a x P x AAAAAA1 2 3 4 5 6 nz o z a z P z ny o y a y P x A A A A A A A1 xA1 (9) 0 0 0 1 1 2 3 45 66 n o a P 6 z z z x 0 0 0 1 where n (normal), o (orientation), a (approach) elements are for orientation and P (position) elements are position 1 where AA I . I is identity matrix. In this case, the elements relative to the reference frame [12]. The 6 6 above equation is resulted in Eq. (10). elements of the matrix shown in left hand side of Eq. (4) are given in Eqs. (5, 6, 7 and 8). nx o x a x P x n SCS( SCCC ( CSS )) CCSS ( ( CCCC ( ny o y a y P x 1 x 641 4123 123 6514 4123 A A A A A xA 1 2 3 45 n o a P 6 CSSSCCSCCS1 2 3)) 5 ( 1 2 3 1 3 2 )) z z z x n SCC( SSSS ( CCS )) CCCS ( ( CSSS ( 0 0 0 1 y 614 4123 231 6514 4123 CCSSCSSCSS)) ( )) (10) 2 3 1 5 2 1 3 3 1 2 n CSCC( ( SS ) CCCS ( CS )) SSCS ( CS ) z 6523 23 4523 32 4623 32 The required multiplication in Eq. (10) is carried out and (5) it yields as Eq. (11). '' '' '' C1 nCoSx 6 x 6 oC x 6 nS x 6 a x Pad x x 6 ox SCSS6514( ( CCCC 4123 ( CSS 123 )) SCCS 5123 ( CCS 132 )) '' '' '' S1 nCoSy 6 y 6 oC y 6 nS y 6 a y Pad y y 6 (11) CCSSCCCCSS6( 4 1 4 ( 1 2 3 1 2 3 )) '' '' '' '' nC oS oC nS a Pad z6 z 6 z 6 z 6 z z z 6 0 0 0 1 0 0 0 1 oy CCC614( SSSS 4123 ( CCS 231 )) SCCS 6514 ( ( CSSS 4123 ( CCSSCSSCSS)) ( )) 2 3 1 5 2 1 3 3 1 2 st th oz SSCC6523( ( SS 23 ) CCCS 4523 ( CS 32 )) CSCS 6423 ( CS 32 ) It is noticed that the elements located in 1 row & 4 column (abbreviated to (1, 4)) and 2nd row & 4th column (6) (abbreviated to (2, 4)) can be used in defining (these abbreviations are also used in the remaining part of the inverse kinematics analysis). All elements in the left-hand ax SSS514( CCCC 4123 ( CSS 123 )) CCCS 5123 ( CCS 132 ) a SCS( CSSS ( CCS )) CCSS ( CSS ) side of the Eq.
Recommended publications
  • Mobile Robot Kinematics
    Mobile Robot Kinematics We're going to start talking about our mobile robots now. There robots differ from our arms in 2 ways: They have sensors, and they can move themselves around. Because their movement is so different from the arms, we will need to talk about a new style of kinematics: Differential Drive. 1. Differential Drive is how many mobile wheeled robots locomote. 2. Differential Drive robot typically have two powered wheels, one on each side of the robot. Sometimes there are other passive wheels that keep the robot from tipping over. 3. When both wheels turn at the same speed in the same direction, the robot moves straight in that direction. 4. When one wheel turns faster than the other, the robot turns in an arc toward the slower wheel. 5. When the wheels turn in opposite directions, the robot turns in place. 6. We can formally describe the robot behavior as follows: (a) If the robot is moving in a curve, there is a center of that curve at that moment, known as the Instantaneous Center of Curvature (or ICC). We talk about the instantaneous center, because we'll analyze this at each instant- the curve may, and probably will, change in the next moment. (b) If r is the radius of the curve (measured to the middle of the robot) and l is the distance between the wheels, then the rate of rotation (!) around the ICC is related to the velocity of the wheels by: l !(r + ) = v 2 r l !(r − ) = v 2 l Why? The angular velocity is defined as the positional velocity divided by the radius: dθ V = dt r 1 This should make some intuitive sense: the farther you are from the center of rotation, the faster you need to move to get the same angular velocity.
    [Show full text]
  • Abbreviations and Glossary
    Appendix A Abbreviations and Glossary Abbreviations are defined and the mathematical symbols and notations used in this book are specified. Furthermore, the random number generator used in this book is referenced. A.1 Abbreviations arccos arccosine BiRRT Bidirectional rapidly growing random tree C-space Configuration space DH Denavit-Hartenberg DLR German aerospace center DOF Degree of freedom FFT Fast fourier transformation IK Inverse kinematics HRI Human-Robot interface LWR Light weight robot MMI Institute of Man-Machine interaction PCA Principal component analysis PRM Probabilistic road map RRT Rapidly growing random tree rulaCapMap Rula-restricted capability map RULA Rapid upper limb assessment SFE Shape fit error TCP Tool center point OV workspace overlap 130 A Abbreviations and Glossary A.2 Mathematical Symbols C configuration space K(q) direct kinematics H set of all homogeneous matrices WR reachable workspace WD dexterous workspace WV versatile workspace F(R,x) function that maps to a homogeneous matrix VRobot voxel space for the robot arm VHuman voxel space for the human arm P set of points on the sphere Np set of point indices for the points on the sphere No set of orientation indices OS set of all homogeneous frames distributed on a sphere MS capability map A.3 Mathematical Notations a scalar value a vector aT vector transposed A matrix AT matrix transposed < a,b > inner product 3 SO(3) group of rotation matrices ∈ IR SO(3) := R ∈ IR 3×3| RRT = I,detR =+1 SE(3) IR 3 × SO(3) A TB reference frame B given in coordinates of reference frame A a ceiling function a floor function A.4 Random Sampling In this book, the drawing of random samples is often used.
    [Show full text]
  • KINEMATIC ANALYSIS of a THUMB-EXOSKELETON SYSTEM for POST STROKE REHABILITATION By
    KINEMATIC ANALYSIS OF A THUMB-EXOSKELETON SYSTEM FOR POST STROKE REHABILITATION By Vikash Gupta Thesis Submitted to the Faculty of the Graduate School of Vanderbilt University in partial fulfillment of the requirements for the degree of MASTER OF SCIENCE in Mechanical Engineering August, 2010 Nashville, Tennessee Approved: Professor Nilanjan Sarkar Professor Derek Kamper Professor Robert Webster III ACKNOWLEDGEMENTS I will like to extend my sincere thanks to Dr. Nilanjan Sarkar for his continuous support and guidance, for his encouragement and advice throughout my studies. He has always been a source of inspiration for me. I would also like to thank Dr. Derek Kamper from Rehabilitation Institute of Chicago, for providing valuable comments on the thesis and being supportive throughout the research. My deep gratitude and sincere thanks goes to my parents and my sister, Swati Gupta. Their invaluable support, understanding and encouragement from far home has always helped me to continue my research. I would also like to thank Hari Kr. Voruganti, Mukul Singhee, Abhishek Chowdhury, Sayantan Chatterjee and Raktim Mitra for their support. My sincere thanks goes to Nino Dzotsenidze, who has always supported and believed in me and helped me make the right decisions at all times. Without her support and encouragement, it would have not been possible. I would also like to thank and express my sincere gratitude to my colleagues and friends Milind Shashtri, Furui Wang, Yu Tian, Jadav Das and Uttama Lahiri at Robotics and Autonomous Systems Laboratory for their support. Last but not the least, I want to express my humble thanks and appreciation to Suzanne Weiss from the Mechanical Engineering department for always being supportive.
    [Show full text]
  • Nyku: a Social Robot for Children with Autism Spectrum Disorders
    University of Denver Digital Commons @ DU Electronic Theses and Dissertations Graduate Studies 2020 Nyku: A Social Robot for Children With Autism Spectrum Disorders Dan Stephan Stoianovici University of Denver Follow this and additional works at: https://digitalcommons.du.edu/etd Part of the Disability Studies Commons, Electrical and Computer Engineering Commons, and the Robotics Commons Recommended Citation Stoianovici, Dan Stephan, "Nyku: A Social Robot for Children With Autism Spectrum Disorders" (2020). Electronic Theses and Dissertations. 1843. https://digitalcommons.du.edu/etd/1843 This Thesis is brought to you for free and open access by the Graduate Studies at Digital Commons @ DU. It has been accepted for inclusion in Electronic Theses and Dissertations by an authorized administrator of Digital Commons @ DU. For more information, please contact [email protected],[email protected]. Nyku : A Social Robot for Children with Autism Spectrum Disorders A Thesis Presented to the Faculty of the Daniel Felix Ritchie School of Engineering and Computer Science University of Denver In Partial Fulfillment of the Requirements for the Degree Master of Science by Dan Stoianovici August 2020 Advisor: Dr. Mohammad H. Mahoor c Copyright by Dan Stoianovici 2020 All Rights Reserved Author: Dan Stoianovici Title: Nyku: A Social Robot for Children with Autism Spectrum Disorders Advisor: Dr. Mohammad H. Mahoor Degree Date: August 2020 Abstract The continued growth of Autism Spectrum Disorders (ASD) around the world has spurred a growth in new therapeutic methods to increase the positive outcomes of an ASD diagnosis. It has been agreed that the early detection and intervention of ASD disorders leads to greatly increased positive outcomes for individuals living with the disorders.
    [Show full text]
  • A Review of Parallel Processing Approaches to Robot Kinematics and Jacobian
    Technical Report 10/97, University of Karlsruhe, Computer Science Department, ISSN 1432-7864 A Review of Parallel Processing Approaches to Robot Kinematics and Jacobian Dominik HENRICH, Joachim KARL und Heinz WÖRN Institute for Real-Time Computer Systems and Robotics University of Karlsruhe, D-76128 Karlsruhe, Germany e-mail: [email protected] Abstract Due to continuously increasing demands in the area of advanced robot control, it became necessary to speed up the computation. One way to reduce the computation time is to distribute the computation onto several processing units. In this survey we present different approaches to parallel computation of robot kinematics and Jacobian. Thereby, we discuss both the forward and the reverse problem. We introduce a classification scheme and classify the references by this scheme. Keywords: parallel processing, Jacobian, robot kinematics, robot control. 1 Introduction Due to continuously increasing demands in the area of advanced robot control, it became necessary to speed up the computation. Since it should be possible to control the motion of a robot manipulator in real-time, it is necessary to reduce the computation time to less than the cycle rate of the control loop. One way to reduce the computation time is to distribute the computation over several processing units. There are other overviews and reviews on parallel processing approaches to robotic problems. Earlier overviews include [Lee89] and [Graham89]. Lee takes a closer look at parallel approaches in [Lee91]. He tries to find common features in the different problems of kinematics, dynamics and Jacobian computation. The latest summary is from Zomaya et al. [Zomaya96].
    [Show full text]
  • Arxiv:2102.12942V3 [Cs.RO] 30 Mar 2021 Drawback of These Strategies Is That They Are Extremely Sensitive to Inaccuracies in the Model
    Structured Prediction for CRiSP Inverse Kinematics Learning with Misspecified Robot Models Gian Maria Marconi∗,1,2 Raffaello Camoriano∗,2 Lorenzo Rosasco2,3,4 Carlo Ciliberto5 [email protected] raff[email protected] [email protected] [email protected] Abstract With the recent advances in machine learning, problems that traditionally would require accurate modeling to be solved analytically can now be successfully approached with data-driven strategies. Among these, computing the inverse kinematics of a redundant robot arm poses a significant challenge due to the non-linear structure of the robot, the hard joint constraints and the non-invertible kinematics map. Moreover, most learning algorithms consider a completely data-driven approach, while often useful information on the structure of the robot is available and should be positively exploited. In this work, we present a simple, yet effective, approach for learning the inverse kinematics. We introduce a structured prediction algorithm that combines a data-driven strategy with the model provided by a forward kinematics function – even when this function is misspecified – to accurately solve the problem. The proposed approach ensures that predicted joint configurations are well within the robot’s constraints. We also provide statistical guarantees on the generalization properties of our estimator as well as an empirical evaluation of its performance on trajectory reconstruction tasks. 1 Introduction Computing the inverse kinematics of a robot is a well-known key problem in several applications requiring robot control [20]. This task consists in finding a set of joint configurations that would result in a given pose of the end effector, and is traditionally solved by assuming access to an accurate model of the robot and employing geometric or numerical optimization techniques.
    [Show full text]
  • Acknowledgements Acknowl
    2161 Acknowledgements Acknowl. B.21 Actuators for Soft Robotics F.58 Robotics in Hazardous Applications by Alin Albu-Schäffer, Antonio Bicchi by James Trevelyan, William Hamel, The authors of this chapter have used liberally of Sung-Chul Kang work done by a group of collaborators involved James Trevelyan acknowledges Surya Singh for de- in the EU projects PHRIENDS, VIACTORS, and tailed suggestions on the original draft, and would also SAPHARI. We want to particularly thank Etienne Bur- like to thank the many unnamed mine clearance experts det, Federico Carpi, Manuel Catalano, Manolo Gara- who have provided guidance and comments over many bini, Giorgio Grioli, Sami Haddadin, Dominic Lacatos, years, as well as Prof. S. Hirose, Scanjack, Way In- Can zparpucu, Florian Petit, Joshua Schultz, Nikos dustry, Japan Atomic Energy Agency, and Total Marine Tsagarakis, Bram Vanderborght, and Sebastian Wolf for Systems for providing photographs. their substantial contributions to this chapter and the William R. Hamel would like to acknowledge work behind it. the US Department of Energy’s Robotics Crosscut- ting Program and all of his colleagues at the na- C.29 Inertial Sensing, GPS and Odometry tional laboratories and universities for many years by Gregory Dudek, Michael Jenkin of dealing with remote hazardous operations, and all We would like to thank Sarah Jenkin for her help with of his collaborators at the Field Robotics Center at the figures. Carnegie Mellon University, particularly James Os- born, who were pivotal in developing ideas for future D.36 Motion for Manipulation Tasks telerobots. by James Kuffner, Jing Xiao Sungchul Kang acknowledges Changhyun Cho, We acknowledge the contribution that the authors of the Woosub Lee, Dongsuk Ryu at KIST (Korean Institute first edition made to this chapter revision, particularly for Science and Technology), Korea for their provid- Sect.
    [Show full text]
  • Kinematics, Kinematics Chains Previously
    Kinematics, Kinematics Chains Previously • Representation of rigid body motion • Two different interpretations - as transformations between different coordinate frames - as operators acting on a rigid body • Representation in terms of homogeneous coordinates • Composition of rigid body motions • Inverse of rigid body motion Rigid Body Transform Translation only is the origin of the frame B expressed in the Frame A Composite transformation: {B} Transformation: Homogeneous coordinates The points from frame A to frame B are {A} transformed by the inverse of (see example next slide) Kinematic Chains • We will focus on mobile robots (brief digression) • In general robotics - study of multiple rigid bodies lined together (e.g. robot manipulator) • Kinematics – study of position, orientation, velocity, acceleration regardless of the forces • Simple examples of kinematic model of robot manipulator and mobile robot • Components – links, connected by joints Various joints Kinematic Chains Tool frame Base frame • Given determine what is • Given determine what is • We can control , want to understand how it affects position of the tool frame • How does the position of the tool frame change as the manipulator articulates • Actuators change the joint angles Forward kinematics for a 2D arm • Find position of the end effector as a function of the joint angles • Blackboard example Kinematic Chains in 3D • More joints possible (spherical, screw) • Additional offset parameters, more complicated • Same idea: set up frame with each link • Define relationship
    [Show full text]
  • Lecture 10 Forward Kinematics Katie DC Feb
    lecture 10 forward kinematics Katie DC Feb. 25, 2020 Modern Robotics Ch. 4 Admin • Guest Lecture on Thursday 2/27 • Quiz 1 re-take is this week • HW3: PF Implementation due next week • HW5 due this week • I’ll be posting a course feedback form this week What is Forward Kinematics? • Kinematics: a branch of classical mechanics that describes motion of bodies without considering forces. AKA “the geometry of motion” • Forward kinematics: a specific problem in robotics. Given the individual state of each joint of the robot (in a local frame), what is the position of a given point on the robot in the global frame? Where is forward kinematics used? Forward Kinematics of a Simple Chain Assumptions • Our robot is a kinematic chain, made of rigid links and movable joints • No branches or loops (will discuss later) • All joints have one degree of freedom and are revolute or prismatic Review of Screw Motions We derived a representation for the screw axis: 휔 풮 = ∈ ℝ6 푣 where either • 휔 = 1 • where 푣 = −휔 × 푞 + ℎ휔, where 푞 is the point on the axis of the screw and ℎ is the pitch of the screw • 휔 = 0 and 푣 = 1 Screw Motions as Matrix Exponential The screw axis 풮푖 can be expressed in matrix form as: 휔 푣 풮 = 푖 ∈ 푠푒 3 푖 0 0 To express a screw motion given a screw axis, we use the matrix exponential: 푒 풮 휃 ∈ 푆퐸 3 Modeling Robot Joints as Screw Motions Case 1: Revolute Joint • 휔 = 1 • 푣 = −휔 × 푞 + ℎω • 푣 = −휔 × 푞 Modeling Robot Joints as Screw Motions Case 2: Prismatic Joint • 휔 = 0 • 푣 = 1 • Axis of movement defines 푣 Product of Exponentials Approach Let
    [Show full text]
  • Learning Tracking Control with Forward Models
    Learning Tracking Control with Forward Models Botond Bocsi´ Philipp Hennig Lehel Csato´ Jan Peters Abstract— Performing task-space tracking control on redun- or not directly actuated elements are hard to model accurately dant robot manipulators is a difficult problem. When the with physics and even harder to control. In our experiments, physical model of the robot is too complex or not available, a ball has been attached to the end-effector of a Barrett standard methods fail and machine learning algorithms can have advantages. We propose an adaptive learning algorithm WAM [9] robot arm using a string, and the ball had to for tracking control of underactuated or non-rigid robots where follow a desired trajectory instead of the end-effector of the the physical model of the robot is unavailable. The control robot. For this system even the forward kinematics model method is based on the fact that forward models are relatively is undefined since the same joint configuration can result in straightforward to learn and local inversions can be obtained different ball positions (due to the swinging of the ball). This via local optimization. We use sparse online Gaussian process inference to obtain a flexible probabilistic forward model and underactuated robot is not straightforward to control since the second order optimization to find the inverse mapping. Physical swinging produces non-linear effects that lead to undefinable experiments indicate that this approach can outperform state- forward or inverse models. We were able to control such of-the-art tracking control algorithms in this context. a robot and show that our method is capable of capturing non-linear effects, like the centrifugal force, into the control I.
    [Show full text]
  • Planar Kinematics
    Introduction to Robotics, H. Harry Asada 1 Chapter 4 Planar Kinematics Kinematics is Geometry of Motion. It is one of the most fundamental disciplines in robotics, providing tools for describing the structure and behavior of robot mechanisms. In this chapter, we will discuss how the motion of a robot mechanism is described, how it responds to actuator movements, and how the individual actuators should be coordinated to obtain desired motion at the robot end-effecter. These are questions central to the design and control of robot mechanisms. To begin with, we will restrict ourselves to a class of robot mechanisms that work within a plane, i.e. Planar Kinematics. Planar kinematics is much more tractable mathematically, compared to general three-dimensional kinematics. Nonetheless, most of the robot mechanisms of practical importance can be treated as planar mechanisms, or can be reduced to planar problems. General three-dimensional kinematics, on the other hand, needs special mathematical tools, which will be discussed in later chapters. 4.1 Planar Kinematics of Serial Link Mechanisms Example 4.1 Consider the three degree-of-freedom planar robot arm shown in Figure 4.1.1. The arm consists of one fixed link and three movable links that move within the plane. All the links are connected by revolute joints whose joint axes are all perpendicular to the plane of the links. There is no closed-loop kinematic chain; hence, it is a serial link mechanism. y A 3 E End Effecter ⎛ xe ⎞ Link 3 ⎜ ⎟ ⎝ ye ⎠ A 2 θ3 φ B e A1 Link 2 Joint 3 θ 2 Link 1 A Joint 2 Joint 1 θ O 1 x Link 0 Figure 4.1.1 Three dof planar robot with three revolute joints To describe this robot arm, a few geometric parameters are needed.
    [Show full text]
  • Forward Kinematics of RRR Robot Manipulator (1/2)
    1/39 Introduction Robotics dr Dragan Kosti ć WTB Dynamics and Control September-October 2009 Introduction Robotics, lecture 3 of 7 2/39 Outline • Recapitulation • Forward kinematics • Inverse kinematics problem Introduction Robotics, lecture 3 of 7 3/39 Recapitulation Introduction Robotics, lecture 3 of 7 4/39 Robot manipulators • Kinematic chain is series of links and joints. SCARA geometry • Types of joints: – rotary (revolute, θ) – prismatic (translational, d). Introduction Robotics, lecture 3 of 7 schematic representations of robot joints 5/39 Common geometries of robot manipulators Introduction Robotics, lecture 3 of 7 6/39 Forward kinematics problem • Determine position and orientation of the end-effector as function of displacements in robot joints. Introduction Robotics, lecture 3 of 7 7/39 DH convention for homogenous transformations (1/2) • An arbitrary homogeneous transformation is based on 6 independent variables: 3 for rotation + 3 for translation. • DH convention reduces 6 to 4, by specific choice of the coordinate frames. • In DH convention, each homogeneous transformation has the form: Introduction Robotics, lecture 3 of 7 8/39 DH convention for homogenous transformations (2/2) • Position and orientation of coordinate frame i with respect to frame i-1 is specified by homogenous transformation matrix: q xn z 0 0 q i+1 zn qi ‘0’ n y0 αi ‘ ’ yn zi ai x0 xi di z i-1 q where i xi-1 Introduction Robotics, lecture 3 of 7 9/39 Physical meaning of DH parameters • Link length ai is distance from zi-1 to zi measured along xi. q xn z 0 • Link twist α is angle between z 0 q i i-1 i+1 zn qi and z measured in plane normal ‘0’ n i y0 αi ‘ ’ yn zi ai to x (right -hand rule).
    [Show full text]