Manipulator Dynamics Amirkabir University of Technology Computer Engineering & Information Technology Department.

Slides:



Advertisements
Similar presentations
AP Physics C Mechanics Review.
Advertisements

Chapters 17, 18 Review. Der Innere Schweinehund (The inner Pigdog)
Accounting for Angular Momentum Chapter 21. Objectives Understand the basic fundamentals behind angular momentum Be able to define measures of rotary.
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.
Dynamics of Rotational Motion
Dynamics of Serial Manipulators
Chapter 8 Rotational Equilibrium and Rotational Dynamics.
Rotational Dynamics Chapter 9.
Chapter 11 Angular Momentum; General Rotation Introduction Recap from Chapter 10 –Used torque with axis fixed in an inertial frame –Used equivalent of.
Chapter 11 Angular Momentum.
R.Parent, CSE788 OSU Constrained Body Dynamics Chapter 4 in: Mirtich Impulse-based Dynamic Simulation of Rigid Body Systems Ph.D. dissertation, Berkeley,
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.
Physics 111: Mechanics Lecture 09
Physics 106: Mechanics Lecture 03
ME Robotics Dynamics of Robot Manipulators Purpose: This chapter introduces the dynamics of mechanisms. A robot can be treated as a set of linked.
Chapter 10: Rotation. Rotational Variables Radian Measure Angular Displacement Angular Velocity Angular Acceleration.
Ch. 7: Dynamics.
Phy 211: General Physics I Chapter 10: Rotation Lecture Notes.
Ch. 4: Velocity Kinematics
Mechanics of Rigid Bodies
Physics 106: Mechanics Lecture 02
Introduction to ROBOTICS
© 2011 Autodesk Freely licensed for use by educational institutions. Reuse and changes require a note indicating that content has been modified from the.
Velocities and Static Force
Definition of an Industrial Robot
Rotation and angular momentum
Spring Topic Outline for Physics 1 Spring 2011.
February 21, 2000Robotics 1 Copyright Martin P. Aalund, Ph.D. Computational Considerations.
College of Physics Science & Technology YANGZHOU UNIVERSITYCHINA Chapter 11ROTATION 11.1 The Motion of Rigid Bodies Rigid bodies A rigid body is.
Chapter 11 Angular Momentum. The Vector Product There are instances where the product of two vectors is another vector Earlier we saw where the product.
Chapters 10, 11 Rotation and angular momentum. Rotation of a rigid body We consider rotational motion of a rigid body about a fixed axis Rigid body rotates.
Robot Dynamics – Slide Set 10 ME 4135 R. R. Lindeke, Ph. D.
Chapter 10 Rotation of a Rigid Object about a Fixed Axis.
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
Chapter 9: Rotational Dynamics
1 Fundamentals of Robotics Linking perception to action 2. Motion of Rigid Bodies 南台科技大學電機工程系謝銘原.
Advanced Computer Graphics Rigid Body Simulation Spring 2002 Professor Brogan.
Chapter 11 Angular Momentum. Angular momentum plays a key role in rotational dynamics. There is a principle of conservation of angular momentum.  In.
Rotational Kinetic Energy An object rotating about some axis with an angular speed, , has rotational kinetic energy even though it may not have.
Dynamics of Linked Hierarchies
1 Dynamics Differential equation relating input torques and forces to the positions (angles) and their derivatives. Like force = mass times acceleration.
Lagrangian Mechanics A short overview. Introduction Previously studied Kinematics and differential motions of robots Now Dynamic analysis Inertias, masses,
Wednesday, Nov. 20, 2002PHYS , Fall 2002 Dr. Jaehoon Yu 1 PHYS 1443 – Section 003 Lecture #19 Monday, Nov. 20, 2002 Dr. Jaehoon Yu 1.Energy of.
Robotics II Copyright Martin P. Aalund, Ph.D.
1 Work in Rotational Motion Find the work done by a force on the object as it rotates through an infinitesimal distance ds = r d  The radial component.
Rigid Body Dynamics CSE169: Computer Animation
Wednesday, Nov. 10, 2004PHYS , Fall 2004 Dr. Jaehoon Yu 1 1.Moment of Inertia 2.Parallel Axis Theorem 3.Torque and Angular Acceleration 4.Rotational.
INTRODUCTION TO DYNAMICS ANALYSIS OF ROBOTS (Part 1)
Chapter 17 Rigid Body Dynamics. Unconstrained Motion: 3 Equations for x, y, rotation.
Particle Kinematics Direction of velocity vector is parallel to path Magnitude of velocity vector is distance traveled / time Inertial frame – non accelerating,
Chapter 4 Dynamic Analysis and Forces 4.1 INTRODUCTION In this chapters …….  The dynamics, related with accelerations, loads, masses and inertias. In.
1 7. Rotational motion In pure rotation every point of an object moves in a circle whose center lies on the axis of rotation (in translational motion the.
Two-Dimensional Rotational Dynamics 8.01 W09D2
Velocity Propagation Between Robot Links 3/4 Instructor: Jacob Rosen Advanced Robotic - MAE 263D - Department of Mechanical & Aerospace Engineering - UCLA.
Constrained Body Dynamics
Robot Dynamics – Newton- Euler Recursive Approach
Manipulator Dynamics 1 Instructor: Jacob Rosen
ROTATIONAL MOTION Rotation axis: rotation occurs about an axis that does not move: fixed axis.
7. Rotational motion In pure rotation every point of an object moves in a circle whose center lies on the axis of rotation (in translational motion the.
Introduction To Robotics
Lecture Rigid Body Dynamics.
Lecture 16 Newton Mechanics Inertial properties,Generalized Coordinates Ruzena Bajcsy EE
Manipulator Dynamics 4 Instructor: Jacob Rosen
Rotational Dynamics Chapter 9.
Manipulator Dynamics 2 Instructor: Jacob Rosen
Outline: 5.1 INTRODUCTION
Outline: 5.1 INTRODUCTION
Presentation transcript:

Manipulator Dynamics Amirkabir University of Technology Computer Engineering & Information Technology Department

Introduction Robot arm dynamics deals with the mathematical formulations of the equations of robot arm motion. They are useful as: An insight into the structure of the robot system. A basis for model based control systems. A basis for computer simulations.

Equations of Motion The way in which the motion of the manipulator arises from torques applied by the actuators, or from external forces applied to the manipulator.

Forward and Inverse Dynamics Given a trajectory point, and find the required vectors of joint torques, Given a torque vector, calculate the resulting motion of the manipulator, and : problem of controlling the manipulator : problem of simulating the manipulator

Two Approaches Energy based: Lagrange-Euler. Simple and symmetric. Momentum/force approach:Newton-Euler. Efficient, derivation is simple but messy, involves vector cross product. Allow real time control.

Newton-Euler Algorithm Newton-Euler method is described briefly below. The goal is to provide a big picture understanding of these methods without getting lost in the details.

Newton-Euler Algorithm Newton-Euler formulations makes two passes over the links of manipulator Velocities, Accelerations Forces, moments Gravity

Newton-Euler Algorithm Forward computation First compute the angular velocity, angular acceleration, linear velocity, linear acceleration of each link in terms of its preceding link. These values can be computed in recursive manner, starting from the first moving link and ending at the end-effector link. The initial conditions for the base link will make the initial velocity and acceleration values to zero.

Newton-Euler Algorithm Backward computation Once the velocities and accelerations of the links are found, the joint forces can be computed one link at a time starting from the end-effector link and ending at the base link.

Differentiation of position vectors Derivative of a vector: We are calculating the derivative of Q relative to frame B.

Differentiation of position vectors A velocity vector may be described in terms of any frame: We may write it: Speed vector is a free vector Special case: Velocity of the origin of a frame relative to some understood universe reference frame

Example 5.1 Both vehicles are heeding in X direction of U 100 mph A fixed universal frame 30 mph

Angular velocity vector: Linear velocity  attribute of a point Angular velocity  attribute of a body Since we always attach a frame to a body we can consider angular velocity as describing rational motion of a frame.

Angular velocity vector: describes the rotation of frame {B} relative to {A} direction of indicates instantaneous axis of rotation Magnitude of indicates speed of rotation In the case which there is an understood reference frame:

Linear velocity of a rigid body We wish to describe motion of {B} relative to frame {A} Attach a coordinate system to any body and study the motion of frames relative to one another. If rotation is not changing with time:

Rotational velocity of a rigid body Two frames with coincident origins The orientation of B with respect to A is changing in time. Lets consider that vector Q is constant as viewed from B.

Rotational velocity of a rigid body Is perpendicular to and Magnitude of differential change is: Vector cross product

Rotational velocity of a rigid body In general case:

Simultaneous linear and rotational velocity We skip 5.4!

Motion of the Links of a Robot Written in frame i At any instant, each link of a robot in motion has some linear and angular velocity.

Velocity of a Link Remember that linear velocity is associated with a point and angular velocity is associated with a body. Thus: The velocity of a link means the linear velocity of the origin of the link frame and the rotational velocity of the link

Velocity Propagation From Link to Link We can compute the velocities of each link in order starting from the base. The velocity of link i+1 will be that of link i, plus whatever new velocity component added by joint i+1.

Rotational Velocity Rotational velocities may be added when both w vectors are written with respect to the same frame. Therefore the angular velocity of link i+1 is the same as that of link i plus a new component caused by rotational velocity at joint i+1.

Velocity Vectors of Neighboring Links

Velocity Propagation From Link to Link Note that: By premultiplying both sides of previous equation to:

Linear Velocity The linear velocity of the origin of frame {i+1} is the same as that of the origin of frame {i} plus a new component caused by rotational velocity of link i.

Linear Velocity Simultaneous linear and rotational velocity: By premultiplying both sides of previous equation to:

Prismatic Joints Link For the case that joint i+1 is prismatic:

Velocity Propagation From Link to Link Applying those previous equations successfully from link to link, we can compute the rotational and linear velocities of the last link.

Example 5.3 Calculate the velocity of the tip of the arm as a function of joint rates? A 2-link manipulator with rotational joints

Example 5.3 Frame assignments for the two link manipulator

Example 5.3 We compute link transformations:

Example 5.3 Link to link transformation

Example 5.3 Velocities with respect to non moving base

Derivative of a Vector Function If we have a vector function r which represents a particle’s position as a function of time t:

Vector Derivatives We’ve seen how to take a derivative of a vector vs. A scalar What about the derivative of a vector vs. A vector?

Acceleration of a Rigid Body Linear and angular accelerations:

Linear Acceleration : origins are coincident. : re-write it as. : by differentiating.

Linear Acceleration the case in which the origins are not coincident : when is constant : the linear acceleration of the links of a manipulator with rotational joints.

Angular Acceleration B is rotation relative to A and C is rotating relative to B : the angular acceleration of the links of a manipulator.

Inertia If a force acts of a body, the body will accelerate. The ratio of the applied force to the resulting acceleration is the inertia (or mass) of the body. If a torque acts on a body that can rotate freely about some axis, the body will undergo an angular acceleration. The ratio of the applied torque to the resulting angular acceleration is the rotational inertia of the body. It depends not only on the mass of the body, but also on how that mass is distributed with respect to the axis.

Mass Distribution Inertia tensor- a generalization of the scalar moment of inertia of an object

Moment of Inertia The moment of inertia of a solid body with density w.r.t. a given axis is defined by the volume integral where r is the perpendicular distance from the axis of rotation.

Moment of Inertia This can be broken into components as: for a discrete distribution of mass for a continuous distribution of mass

Moment of Inertia The inertia tensor relative to frame {A}: Mass moments of inertia Mass products of inertia

Moment of Inertia If we are free to choose the orientation of the reference frame, it is possible to cause the products of inertia to be zero. Principal axes. Principal moments of inertia.

Example 6.1 {C}

Parallel Axis Theorem Relates the inertia tensor in a frame with origin at the center of mass to the inertia tensor w.r.t. another reference frame.

Measuring the Moment of Inertia of a Link Most manipulators have links whose geometry and composition are somewhat complex. A pragmatic option is to measure the moment of inertia of each link using an inertia pendulum. If a body suspended by a rod is given a small twist about the axis of suspension, it will oscillate with angular harmonic motion, the period of which is given by. where k is the torsion constant of the suspending rod , i.e., the constant ratio between the restoring torque and the angular displacement.

Newton’s Equation Force causing the acceleration

Euler’s Equation Moment causing the rotation

Iterative Newton-Euler Dynamic Formulation Outward iterations to compute velocities and accelerations The force and torque acting on a link Inward iterations to compute forces and torques

The Force Balance for a Link

The Torque Balance for a Link

Force Balance Using result of force and torque balance: In iterative form:

The Iterative Newton-Euler Dynamics Algorithm 1st step: Link velocities and accelerations are iteratively computed from link 1 out to link n and the Newton-Euler equations are applied to each link. 2nd step: Forces and torques of iteration and joint actuator torques are computed recursively from link n back to link 1.

Outward iterations

Inward iterations

Inclusion of Gravity Forces The effect of gravity loading on the links can be included by setting , where G is the gravity vector.

The Structure of the Manipulator Dynamic Equations : state space equation : mass matrix : centrifugal and Coriolis terms : gravity terms : configuration space : matrix of Coriolis coefficients : centrifugal coefficients

Coriolis Force A fictitious force exerted on a body when it moves in a rotating reference frame.

Lagrangian Formulation of Manipulator Dynamics An energy-based approach (N-E: a force balance approach) N-E and Lagrangian formulation will give the same equations of motion.

Kinetic and Potential Energy of a Manipulator Total kinetic energy of a manipulator Total potential energy of a manipulator

Lagrangian Is the difference between the kinetic and potential energy of a mechanical system

The equations of motion for the manipulator vector of actuator torque

Example 6.5 : variable The center of mass of link 1 and link 2

Manipulator Dynamics in Cartesian Space Joint space formulation Cartesian space formulation

Expressions for the terms in the Cartesian dynamics:

The Cartesian configuration space torque equation: :Coriolis coefficients :Centrifugal coefficients

Dynamic Simulation: (Euler Integration) Simulation requires solving the dynamic equation for acceleration Nonrigid body effects: friction : Given initial conditions We apply numerical integration to compute positions and velocities:

Trajectory Generation Next Course: Trajectory Generation Amirkabir University of Technology Computer Engineering & Information Technology Department