The L-E (Torque) Dynamical Model: Inertial Forces Coriolis & Centrifugal Forces Gravitational Forces Frictional Forces.

Slides:



Advertisements
Similar presentations
ME 4135 Robotics & Control R. Lindeke, Ph. D.. FKS vs. IKS  In FKS we built a tool for finding end frame geometry from Given Joint data:  In IKS we.
Advertisements

ME 4135 Differential Motion and the Robot Jacobian Slide Series 6 Fall 2011 R. R. Lindeke, Ph.D.
Mechatronics 1 Weeks 5,6, & 7. Learning Outcomes By the end of week 5-7 session, students will understand the dynamics of industrial robots.
Manipulator Dynamics Amirkabir University of Technology Computer Engineering & Information Technology Department.
Continuing with Jacobian and its uses ME 4135 – Slide Set 7 R. R. Lindeke, Ph. D.
Dynamics of Serial Manipulators
Two-link Planar Arm 让学生做练习。推导时计算bij对q的偏导数。最终动力学模型保留在黑板上。
T. Bajd, M. Mihelj, J. Lenarčič, A. Stanovnik, M. Munih, Robotics, Springer, 2010 ROBOT DYNAMICS T. Bajd and M. Mihelj.
13.1 Newton’s law of motion 1.Newton’s 2 nd law of motion (1) A particle subjected to an unbalanced force experiences an accelerationhaving the same direction.
Robot Modeling and the Forward Kinematic Solution ME 4135 Lecture Series 4 Dr. R. Lindeke – Fall 2011.
ME 4135 Fall 2011 R. R. Lindeke, Ph. D. Robot Dynamics – The Action of a Manipulator When Forced.
Robot Dynamics – Newton- Euler Recursive Approach ME 4135 Robotics & Controls R. Lindeke, Ph. D.
The L-E (Torque) Dynamical Model: Inertial Forces Coriolis & Centrifugal Forces Gravitational Forces Frictional Forces.
ME Robotics Dynamics of Robot Manipulators Purpose: This chapter introduces the dynamics of mechanisms. A robot can be treated as a set of linked.
Ch. 7: Dynamics.
Euler Rotation. Angular Momentum  The angular momentum J is defined in terms of the inertia tensor and angular velocity. All rotations included  The.
Ch. 4: Velocity Kinematics
Forward Kinematics.
Manipulator Dynamics Amirkabir University of Technology Computer Engineering & Information Technology Department.
Introduction to ROBOTICS
Velocity Analysis Jacobian
Velocities and Static Force
ME 4135 Differential Motion and the Robot Jacobian
ME 4135 Differential Motion and the Robot Jacobian Fall 2012 R. R. Lindeke, Ph.D.
Definition of an Industrial Robot
ME 407 Advanced Dynamics We will learn to model systems that can be viewed as collections of rigid bodies Common mechanical systems Robots Various wheeled.
February 21, 2000Robotics 1 Copyright Martin P. Aalund, Ph.D. Computational Considerations.
Robot Dynamics – Slide Set 10 ME 4135 R. R. Lindeke, Ph. D.
Dynamics.  relationship between the joint actuator torques and the motion of the structure  Derivation of dynamic model of a manipulator  Simulation.
Outline: 5.1 INTRODUCTION
Sect 5.4: Eigenvalues of I & Principal Axis Transformation
INTRODUCTION TO DYNAMICS ANALYSIS OF ROBOTS (Part 3)
1 Fundamentals of Robotics Linking perception to action 2. Motion of Rigid Bodies 南台科技大學電機工程系謝銘原.
Mon 30 July 2007 Overview of the course
ME451 Kinematics and Dynamics of Machine Systems Vel. And Acc. of a Fixed Point in Moving Frame Basic Concepts in Planar Kinematics February.
Advanced Computer Graphics Rigid Body Simulation Spring 2002 Professor Brogan.
M. Zareinejad 1. 2 Grounded interfaces Very similar to robots Need Kinematics –––––– Determine endpoint position Calculate velocities Calculate force-torque.
Dynamics of Linked Hierarchies
Spring Rigid Body Simulation. Spring Contents Unconstrained Collision Contact Resting Contact.
1 Dynamics Differential equation relating input torques and forces to the positions (angles) and their derivatives. Like force = mass times acceleration.
Summary for Chapters 2  4 Kinematics: Average velocity (Instantaneous) velocity  Average acceleration = (Instantaneous) acceleration = Constant acceleration:
Just a quick reminder with another example
Lagrangian Mechanics A short overview. Introduction Previously studied Kinematics and differential motions of robots Now Dynamic analysis Inertias, masses,
Robotics II Copyright Martin P. Aalund, Ph.D.
INTRODUCTION TO DYNAMICS ANALYSIS OF ROBOTS (Part 4)
PHY205 Ch16: Rotational Dynamics 1.Combination Translational and Rotational motion and Atwood machine 2.Discuss Ball rolling down incline from 3 different.
Chapter 12 Lecture 21: Static Equilibrium and Elasticity: I HW8 (problems):11.7, 11.25, 11.39, 11.58, 12.5, 12.24, 12.35, Due on Friday, April 1.
Velocity Propagation Between Robot Links 3/4 Instructor: Jacob Rosen Advanced Robotic - MAE 263D - Department of Mechanical & Aerospace Engineering - UCLA.
Advanced Computer Graphics Rigid Body Simulation
Constrained Body Dynamics
Robot Dynamics – Newton- Euler Recursive Approach
Joint Velocity and the Jacobian
Manipulator Dynamics 1 Instructor: Jacob Rosen
Introduction To Robotics
Lecture Rigid Body Dynamics.
Lecture 16 Newton Mechanics Inertial properties,Generalized Coordinates Ruzena Bajcsy EE
Introduction to ROBOTICS
Manipulator Dynamics 4 Instructor: Jacob Rosen
Outline: 5.1 INTRODUCTION
Manipulator Dynamics 2 Instructor: Jacob Rosen
PROBLEM SET 6 1. What is the Jacobian for translational velocities of point “P” for the following robot? X0 Y0 Y1 X1, Y2 X2 X3 Y3 P 1 What is the velocity.
Rigid Body Dynamics ~ f = p h g
Outline: 5.1 INTRODUCTION
PHY 711 Classical Mechanics and Mathematical Methods
Outline: 5.1 INTRODUCTION
PHY 711 Classical Mechanics and Mathematical Methods
Physics 319 Classical Mechanics
Chapter 4 . Trajectory planning and Inverse kinematics
Chapter 3. Kinematic analysis
Chapter 7 Inverse Dynamics Control
Presentation transcript:

The L-E (Torque) Dynamical Model: Inertial Forces Coriolis & Centrifugal Forces Gravitational Forces Frictional Forces

Lets Apply the Technique -- Lets do it for a 2- Link “Manipulator” Link 1 has a Mass of m1; Link 2 a mass of m2

Before Starting lets define an L-E Algorithm: Step 1 Apply D-H Algorithm to build Ai matrices and find F i the “link frame” Step 2Set T 0 0 = I ; i=1; D(q)=0 Step 3 Find  c i the Homogenous coordinate of the center of mass of link i WRT F i Step 4 Set F c as the translation of Frame F i to C M of i Compute Inertia Tensor D i bar about C M wrt F c Step 5Compute: z i-1 (q); T 0 i ; c i bar (q); D i (q)

Before Starting lets define a L-E Algorithm: Step 6Compute Special Case of J i (q) Step 7 Partition J i and compute D(q) = D(q) i-1 + {A T m i A + B T D i B} Step 8 Set i = i+1 go to step 3 or if i=n+1 then set i=1 & continue Step 9 Compute C i (q) -- Vel. Coupling matrix; h i (q) – gravity loading vector; and friction i Step 10Formulate Torque i equation Step 11Advance “i” go to step 9 until i>n

We Start with Ai’s Not Exactly D-H Legal (unless there is more to the robot than these 2 links!)

So Lets find T 0 2 T 0 2 = A 1 *A 2

I’ll Compute Similar Terms back – to – back rather than by the Algorithm

c 2(bar) Computation:

Finding D i Considers each link a thin cylindrical bar These are Inertial Tensors with respect to a F c aligned with the link Frames i at the C m

Continuing for Link 1

Simplifying:

Continuing for Link 2

Now let’s compute the Jacobians

Finishing J 1 Note the 2nd column is all zeros – even though Joint 2 is revolute – this is the special case!

Jumping into J 2

Continuing:

And Again:

Summarizing J 2 is:

Developing the D(q) Contributions D(q) I = (A i ) T m i A i + (B i ) T D i B i A i is the “Upper half” of the J i matrix B i is the “Lower Half” of the J i matrix D i is the Inertial Tensor of Link i defined in the Base space

Building D 1 D(q) 1 = (A 1 ) T m 1 A 1 + (B 1 ) T D 1 B 1 Here:

Looking at the 1 st Term (Linear Velocity term)

Looking at the 2 nd Term (Angular Velocity term) Recall that D 1 is: Then:

Putting the 2 terms together, D(q) 1 is: 2x2 because it is a 2-jointed robot!!

Building the Full Manipulator D(q) D(q) 2 = D(q) 1 +(A 2 ) T m 2 A 2 + (B 2 ) T D 2 B 2 Recalling (from J 2 ):

Building the ‘2 nd’ Term (the Linear Vel. part from the second link):

Specifics on term (1,1) ~ details!

Building the 3 rd Term: Recall D 2 : Then:

Combining the 3 Terms to construct the Full D(q) Manipulator Inertial Tensor “Solution”: 2x2 because it is 2 Joints (still)!

Simplifying then, the Manipulator inertial Tensor D(q) is: NOTE: D(q) man is Square in number of Joints! 2x2 here because this is a 2-jointed robot!!

This Completes the Fundamental Steps: Now we compute the Velocity Coupling Matrix and Gravitation terms:

For the 1 st Link

Plugging ‘n Chugging (1 st link) From Earlier:

P & C cont – 1 st Link:

Finding h 1 : Given: gravity vector points in –Y 0 direction g k =(0, -g 0, 0) T g 0 is gravitational constant In the h model A ki j is extracted from the relevant Jacobian matrix Here: 3-directions of Cartesian base space! Here, i=1

Continuing (i =1): From Jacobian j Upper half – specified components Gravitational effect: Would be 3 terms (BUT) only K = 2 survives since gravitational vector points in –Y 0 direction

Stepping to Link 2 (i = 2)

Computing h 2 Would be 3 terms (BUT) only K = 2 survives as gravitational vector points in –Y 0 direction

Building “Torque” Models for each Link In General:

For Link 1 (i=1): The 1 st terms: 2 nd Terms:

Writing the Complete Link 1 Model

And, Finally, For Link 2 (i=2):

Initial Link 2 terms: ! st Terms: 2 nd Terms:

Finalizing Link 2 Torque Model: