Inverse Kinematics Jacobian Matrix Trajectory Planning

Slides:



Advertisements
Similar presentations
Robot Modeling and the Forward Kinematic Solution
Advertisements

Robot Modeling and the Forward Kinematic Solution
Outline: Introduction Link Description Link-Connection Description
Links and Joints.
Manipulator’s Inverse kinematics
University of Bridgeport
Review: Homogeneous Transformations
Denavit-Hartenberg Convention
Kinematic Modelling in Robotics
Trajectory Generation
Forward Kinematics. Focus on links chains May be combined in a tree structure Degrees of Freedom Number of independent position variables (i.e. joints.
The City College of New York 1 Dr. Jizhong Xiao Department of Electrical Engineering City College of New York Kinematics of Robot Manipulator.
Trajectory Week 8. Learning Outcomes By the end of week 8 session, students will trajectory of industrial robots.
Time to Derive Kinematics Model of the Robotic Arm
The City College of New York 1 Jizhong Xiao Department of Electrical Engineering City College of New York Manipulator Control Introduction.
Ch. 3: Forward and Inverse Kinematics
Ch. 4: Velocity Kinematics
Forward Kinematics.
Ch. 3: Forward and Inverse Kinematics
Introduction to Robotics Lecture II Alfred Bruckstein Yaniv Altshuler.
Introduction to ROBOTICS
Introduction to ROBOTICS
Introduction to ROBOTICS
KINEMATICS ANALYSIS OF ROBOTS (Part 1) ENG4406 ROBOTICS AND MACHINE VISION PART 2 LECTURE 8.
More details and examples on robot arms and kinematics
Velocity Analysis Jacobian
V ELOCITY A NALYSIS J ACOBIAN University of Bridgeport 1 Introduction to ROBOTICS.
INTRODUCTION TO DYNAMICS ANALYSIS OF ROBOTS (Part 5)
ME/ECE Professor N. J. Ferrier Forward Kinematics Professor Nicola Ferrier ME Room 2246,
Definition of an Industrial Robot
Feb 17, 2002Robotics 1 Copyright Martin P. Aalund, Ph.D. Kinematics Kinematics is the science of motion without regard to forces. We study the position,
Kinematics of Robot Manipulator
Lecture 2: Introduction to Concepts in Robotics
Chapter 2 Robot Kinematics: Position Analysis
Outline: 5.1 INTRODUCTION
Robotics Chapter 5 – Path and Trajectory Planning
The City College of New York 1 Dr. Jizhong Xiao Department of Electrical Engineering City College of New York Inverse Kinematics Jacobian.
Manipulator’s Forward kinematics
SCARA – Forward Kinematics
11/10/2015Handout 41 Robotics kinematics: D-H Approach.
Review: Differential Kinematics
Chapter 7: Trajectory Generation Faculty of Engineering - Mechanical Engineering Department ROBOTICS Outline: 1.
M. Zareinejad 1. 2 Grounded interfaces Very similar to robots Need Kinematics –––––– Determine endpoint position Calculate velocities Calculate force-torque.
Just a quick reminder with another example
MT411 Robotic Engineering
ROBOT VISION LABORATORY 김 형 석 Robot Applications-B
Outline: Introduction Solvability Manipulator subspace when n<6
Trajectory Generation
City College of New York 1 John (Jizhong) Xiao Department of Electrical Engineering City College of New York Mobile Robot Control G3300:
INTRODUCTION TO DYNAMICS ANALYSIS OF ROBOTS (Part 4)
City College of New York 1 Dr. John (Jizhong) Xiao Department of Electrical Engineering City College of New York Review for Midterm.
Forward Kinematics Where is my hand ?. Examples Denavit-Hartenberg Specialized description of articulated figures (joints) Each joint has only one degree.
COMP322/S2000/L111 Inverse Kinematics Given the tool configuration (orientation R w and position p w ) in the world coordinate within the work envelope,
MECH572A Introduction To Robotics Lecture 5 Dept. Of Mechanical Engineering.
COMP322/S2000/L81 Direct Kinematics- Link Coordinates Questions: How do we assign frames? At the Joints? At the Links? Denavit-Hartenberg (D-H) Representation.
Robotics Chapter 3 – Forward Kinematics
Velocity Propagation Between Robot Links 3/4 Instructor: Jacob Rosen Advanced Robotic - MAE 263D - Department of Mechanical & Aerospace Engineering - UCLA.
Kinematics 제어시스템 이론 및 실습 조현우
Denavit-Hartenberg Convention
Denavit-Hartenberg Convention
Ch. 3: Forward and Inverse Kinematics
Introduction to ROBOTICS
Direct Manipulator Kinematics
Zaid H. Rashid Supervisor Dr. Hassan M. Alwan
CHAPTER 2 FORWARD KINEMATIC 1.
Direct Kinematic Model
Mobile Robot Kinematics
Homogeneous Transformation Matrices
Chapter 4 . Trajectory planning and Inverse kinematics
Chapter 3. Kinematic analysis
Presentation transcript:

Inverse Kinematics Jacobian Matrix Trajectory Planning Introduction to ROBOTICS Inverse Kinematics Jacobian Matrix Trajectory Planning Dr. Jizhong Xiao Department of Electrical Engineering City College of New York jxiao@ccny.cuny.edu

Outline Review Jacobian Matrix Trajectory Planning Kinematics Model Inverse Kinematics Example Jacobian Matrix Singularity Trajectory Planning

Review Steps to derive kinematics model: Assign D-H coordinates frames Find link parameters Transformation matrices of adjacent joints Calculate kinematics matrix When necessary, Euler angle representation

Denavit-Hartenberg Convention Number the joints from 1 to n starting with the base and ending with the end-effector. Establish the base coordinate system. Establish a right-handed orthonormal coordinate system at the supporting base with axis lying along the axis of motion of joint 1. Establish joint axis. Align the Zi with the axis of motion (rotary or sliding) of joint i+1. Establish the origin of the ith coordinate system. Locate the origin of the ith coordinate at the intersection of the Zi & Zi-1 or at the intersection of common normal between the Zi & Zi-1 axes and the Zi axis. Establish Xi axis. Establish or along the common normal between the Zi-1 & Zi axes when they are parallel. Establish Yi axis. Assign to complete the right-handed coordinate system. Find the link and joint parameters

Review Link and Joint Parameters Joint angle : the angle of rotation from the Xi-1 axis to the Xi axis about the Zi-1 axis. It is the joint variable if joint i is rotary. Joint distance : the distance from the origin of the (i-1) coordinate system to the intersection of the Zi-1 axis and the Xi axis along the Zi-1 axis. It is the joint variable if joint i is prismatic. Link length : the distance from the intersection of the Zi-1 axis and the Xi axis to the origin of the ith coordinate system along the Xi axis. Link twist angle : the angle of rotation from the Zi-1 axis to the Zi axis about the Xi axis.

Review D-H transformation matrix for adjacent coordinate frames, i and i-1. The position and orientation of the i-th frame coordinate can be expressed in the (i-1)th frame by the following 4 successive elementary transformations: Source coordinate Reference Coordinate

Review Kinematics Equations chain product of successive coordinate transformation matrices of specifies the location of the n-th coordinate frame w.r.t. the base coordinate system Orientation matrix Position vector

Review Forward Kinematics Kinematics Transformation Matrix Why use Euler angle representation? What is ?

Review Yaw-Pitch-Roll Representation (Equation A)

Review Compare LHS and RHS of Equation A, we have:

Inverse Kinematics Transformation Matrix Robot dependent, Solutions not unique Systematic closed-form solution in general is not available Special cases make the closed-form arm solution possible: Three adjacent joint axes intersecting (PUMA, Stanford) Three adjacent joint axes parallel to one another (MINIMOVER)

Example Solving the inverse kinematics of Stanford arm

Example Solving the inverse kinematics of Stanford arm Equation (1) Equation (2) Equation (3) In Equ. (1), let

Example Solving the inverse kinematics of Stanford arm From term (3,3)

Example Solving the inverse kinematics of Stanford arm

Jacobian Matrix Forward Jacobian Matrix Kinematics Inverse Jacobian Matrix: Relationship between joint space velocity with task space velocity Joint Space Task Space

Jacobian Matrix Forward kinematics

Jacobian Matrix Jacobian is a function of q, it is not a constant!

Jacobian Matrix Forward Kinematics Linear velocity Angular velocity

Example 2-DOF planar robot arm Given l1, l2 , Find: Jacobian 1 - 2 1 (x , y) l2 l1

Jacobian Matrix Physical Interpretation How each individual joint space velocity contribute to task space velocity.

Jacobian Matrix Inverse Jacobian Singularity rank(J)<min{6,n}, Jacobian Matrix is less than full rank Jacobian is non-invertable Boundary Singularities: occur when the tool tip is on the surface of the work envelop. Interior Singularities: occur inside the work envelope when two or more of the axes of the robot form a straight line, i.e., collinear

Quiz Find the singularity configuration of the 2-DOF planar robot arm 2 1 (x , y) l2 l1 x Y =0 V determinant(J)=0 Not full rank Det(J)=0

Jacobian Matrix Pseudoinverse Let A be an mxn matrix, and let be the pseudoinverse of A. If A is of full rank, then can be computed as: Example:

Robot Motion Planning Path planning Trajectory planning, Geometric path Issues: obstacle avoidance, shortest path Trajectory planning, “interpolate” or “approximate” the desired path by a class of polynomial functions and generates a sequence of time-based “control set points” for the control of manipulator from the initial configuration to its destination.

Trajectory Planning

Trajectory planning Path Profile Velocity Profile Acceleration Profile

The boundary conditions 1) Initial position 2) Initial velocity 3) Initial acceleration 4) Lift-off position 5) Continuity in position at t1 6) Continuity in velocity at t1 7) Continuity in acceleration at t1 8) Set-down position 9) Continuity in position at t2 10) Continuity in velocity at t2 11) Continuity in acceleration at t2 12) Final position 13) Final velocity 14) Final acceleration

Requirements Initial Position Final Position Position (given) Velocity (given, normally zero) Acceleration (given, normally zero) Final Position

Requirements Intermediate positions set-down position (given) set-down position (continuous with previous trajectory segment) Velocity (continuous with previous trajectory segment) Acceleration (continuous with previous trajectory segment)

Requirements Intermediate positions Lift-off position (given) Lift-off position (continuous with previous trajectory segment) Velocity (continuous with previous trajectory segment) Acceleration (continuous with previous trajectory segment)

Trajectory Planning n-th order polynomial, must satisfy 14 conditions, t0t1, 5 unknow t1t2, 4 unknow t2tf, 5 unknow

How to solve the parameters Handout in the class

Thank you! Homework 3 posted on the web. Next class: Robot Dynamics