From Kinematics to Arm Control a)Calibrating the Kinematics Model b)Arm Motion Selection c)Motor Torque Calculations for a Planetary Robot Arm CS36510.

Slides:



Advertisements
Similar presentations
Foundations of Physics
Advertisements

Circular and Rotational Motion
Outline: Introduction Link Description Link-Connection Description
Rotational Motion Chapter Opener. Caption: You too can experience rapid rotation—if your stomach can take the high angular velocity and centripetal acceleration.
COMP322/S2000/L41 Classification of Robot Arms:by Control Method The Control unit is the brain of the robot. It contains the instructions that direct the.
Manufacturing Automation
Physics Montwood High School R. Casao
Trajectory Generation
INTRODUCTION TO DYNAMICS ANALYSIS OF ROBOTS (Part 6)
Trajectory Planning.  Goal: to generate the reference inputs to the motion control system which ensures that the manipulator executes the planned trajectory.
Rotational Equilibrium and Rotational Dynamics
Torque and Equilibrium Lecture 8 Pre-reading : KJF §8.1 and 8.2.
Chapter 15 Oscillations Oscillatory motion Motion which is periodic in time, that is, motion that repeats itself in time. Examples: Power line oscillates.
Nicholas Lawrance | ICRA Minimum Snap Trajectory Generation for Control of Quadrotors (Best Paper ICRA 2011) Daniel Mellinger and Vijay Kumar GRASP.
Chapter 10 Rotational Motion
Manipulator Dynamics Amirkabir University of Technology Computer Engineering & Information Technology Department.
Simple Harmonic Motion
A force is defined as a push or a pull that acts on an object.
Oscillation.
More details and examples on robot arms and kinematics
Simple Harmonic Motion
Definition of an Industrial Robot
KINESIOLOGY دکترامیر هوشنگ واحدی متخصص طب فیزیکی و توانبخشی قسمت 3.
Chapter 8: Torque and Angular Momentum
Circular Motion Kinematics 8.01 W04D1. Today’s Reading Assignment: W04D1 Young and Freedman: 3.4; Supplementary Notes: Circular Motion Kinematics.
Chapter 7 Work and Energy
Compound Gears Unit 6.
Lecture 2: Introduction to Concepts in Robotics
Inverse Kinematics.
Lecture 18 Rotational Motion
BIPEDAL LOCOMOTION Prima Parte Antonio D'Angelo.
Chapter 5 Trajectory Planning 5.1 INTRODUCTION In this chapters …….  Path and trajectory planning means the way that a robot is moved from one location.
Chapter 5 Trajectory Planning 5.1 INTRODUCTION In this chapters …….  Path and trajectory planning means the way that a robot is moved from one location.
Robotics Chapter 5 – Path and Trajectory Planning
KINEMATICS ANALYSIS OF ROBOTS (Part 2)
ROTATIONAL MOTION AND EQUILIBRIUM
Torque and Equilibrium
Kinesiology Unit 8 1. Definition of Balance: An individual’s ability to control stability 2.
Free fall An object undergoing free fall has an acceleration of m/s2 . This varies from the equator when it is m/s2 to the poles when it.
Chapter 8 Rotational Motion.
DYNAMICS 1. Newton’s Three Laws Newton’s First Law Existence of inertial systems of reference In inertial system of reference, any object acted by no net.
Lab # 3: The Programmable Robot General Engineering Polytechnic University.
Magnetism. Chapter 19 Problems ,2,5, ,15, ,21, , ,38, , ,47.
Lecture me-351 Machine tools and Machining. Statics and dynamics of shaper planner and sloter All of the three machines when in rest or in work are statically.
Unit 4, Chapter 10 CPO Science Foundations of Physics Chapter 9.
Work and Energy 10.1 Machines and Mechanical Advantage 10.2 Work
Chapter 7: Trajectory Generation Faculty of Engineering - Mechanical Engineering Department ROBOTICS Outline: 1.
Unit 4, 5, and 6 Review. Newton’s Law of Universal Gravitation is based on two points First: As distance between two objects increases, gravitational.
Accurate Robot Positioning using Corrective Learning Ram Subramanian ECE 539 Course Project Fall 2003.
Anthony Beeman.  Since the project proposal submittal on 9/21/15 I began work on the Abaqus Kinematic model utilizing join, hinge, and beam elements.
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.
Physics CHAPTER 8 ROTATIONAL MOTION. The Radian  The radian is a unit of angular measure  The radian can be defined as the arc length s along a circle.
Accelerated Motion. Newton’s Second Law of Motion (Law of Force)- Net force acting on an object causes the object to accelerate in the direction of the.
Trajectory Generation
City College of New York 1 John (Jizhong) Xiao Department of Electrical Engineering City College of New York Mobile Robot Control G3300:
Circular Motion and Other Applications of Newton’s Laws
Periodic Motions.
Circular Motion. Rotational Quantities A O r  dAdA A point on an object, located a distance r from a fixed axis of rotation, rotates in such a way that.
Rotational Dynamics Rode, Kiana, Tiana, and Celina.
Industrial Automation and Robotics
UNITS 12 AND 13.
Direct Manipulator Kinematics
Accurate Robot Positioning using Corrective Learning
9/16/2018 Physics 253.
Circular Motion.
7.3 Forces in Two Dimensions
The Magnitude of a Torque
Inverse Kinematics 12/30/2018.
Special English for Industrial Robot
Rotational Statics i.e. “Torque”
Presentation transcript:

From Kinematics to Arm Control a)Calibrating the Kinematics Model b)Arm Motion Selection c)Motor Torque Calculations for a Planetary Robot Arm CS

a) Calibrating the Kinematics Model Resolution, Repeatability and Accuracy Causes of Mechanical Error Calibrating the kinematics model CS

Resolution, Repeatability and Accuracy 1.Resolution: smallest incremental move that a robot can physically produce. 2.Repeatability: a measure of the robot’s ability to move back to the same position and orientation over and over again. Also referred to as ‘precision’. 3.Accuracy: the ability of the robot to move precisely to a desired position in 3D space CS

Repeatability (Precision) and Accuracy Poor Accuracy Poor Repeatability Good Accuracy Poor Repeatability Poor Accuracy Good Repeatability Good Accuracy Good Repeatability (Assuming Gaussian Distribution) CS

Causes of Mechanical Error Denavit-Hartenberg (D-H) Parameters: Link Length (d); Link Offset (a); Link Twist (α); Link Rotation (θ) CS

Calibrating the Beagle 2 Arm Typical Vicon measurement setup Beagle 2 FM Arm with Vicon Markers CS

Oxford Metrics Vicon System ‘Object’definition in Vicon system CS

Calibrating the ARM Kinematics Model The simulated (perfect) arm is moved to a number of positions using the arm IK model. The end position for each simulated Vicon marker is measured. The real arm is then commanded to the same number of predefined positions in Cartesian space using the joint values calculated from the arm IK model. The actual end position for each real Vicon marker is measured. The real and simulated Vicon marker positions are compared and joint offsets (corrections) are calculated for the simulated arm’s IK model using a least-squares fitting method. The result is that the simulated arm with the corrected IK model produces identical positioning results as the real arm. i.e. The simulated arm behaves as per the real arm. CS36510 With IK Model IK model corrections 8

b) Arm Motion Selection Joint-by-Joint Motion (JJM) Slew Motion (SM) Joint Interpolated Motion (JIM) CS

Joint-by-Joint Motion (JJM or JBJ ) Strengths: Simplest of the possible motion types; good for un-stowing and stowing an arm as the major joints can be moved one after another. Typically no straight-line trajectory inverse kinematics solution will exist for this type activity anyway. Good at minimising power usage per unit time. Weaknesses: Joints cannot move simultaneously, hence cannot be used for straight line (continuous) trajectories. Rather payload motion will be in an series of arcs. Large total time to complete all joint motions. CS

Slew Motion (SM) CS Strengths: Also known as “Simultaneous Full Speed” (SFS) motion. All joints that require motion start simultaneously at default joint speeds (usually maximum speed). Quicker joint motion completion when compared to JJM. SM can be used for payload straight-line trajectories. Weaknesses: Greater power usage per unit time compared to JJM. Joints with smaller angular movement complete their motions before those joints with larger angular movements. Smooth straight-line trajectories not possible. Payload motion tends to zig-zag about the desired straight-line trajectory.

Joint Interpolated Motion (JIM) CS Strengths: All joints that require movement start simultaneously and stop simultaneously. Robot attempts to achieve simultaneous start and stop by setting the speed of each joint angular motion to be proportional to the angular distance to be travelled for each joint. Produces smooth straight-line trajectory motion. Weaknesses: Greater power usage per unit time compared to JJM. Greater computational overheads when compared to SM.

Knot Points CS Straight-line trajectory requires knot points (from spline mathematics) to be generated between the start and finish positions. The desired straight-line between the payload start and finish positions can be uniformly divided into intermediate points in Cartesian space (called knot points) 1. Each of these points can be put through the IK model to generate the joint angles required to move the arm to each of these intermediate points in turn; whilst setting each joint speed (e.g. proportional for JIM) to the required angular motion. 1 Taylor, R. H., Planning and Execution of Straight Line Manipulator Trajectories, IBM J. RES. DEVELOP, VOL. 23, NO. 4, pp , JULY Start position Finish position Knot point

c) Motor Torque Calculations for a Planetary Robot Arm What is torque, and why do we need it? –Torque (τ) is defined as a turning (or twisting) force –A robot arm joint motor, with an attached linkage and payload, has to generate a torque to be able to move the linkage and payload –The magnitude of τ depends upon the payload force, and the length of the joint motor linkage CS

Torque Equation - 1 CS τ = F × l where τ is the magnitude of the torque (N·m), l (in meters) is the linkage length, and F (in Newtons) is the magnitude of the force. In the vertical plane, the force acting upon an object (causing it to fall) is the acceleration due to gravity (for Earth, g ≈ 9.81 m/sec 2 ). Therefore F = m × g, where m is the magnitude of the mass of the object (in kg), and F is normally referred to as the object’s weight.

CS Torque Equation - 2 F θ = 90 ⁰ F θ = 45 ⁰ F θ = 0 ⁰ τ is zero τ is maximum sin 90° = 1 sin 45° = 0.7 sin 0° = 0 τ = F × l × sinθ L L L L Joint Motor Linkage (length l) maximum > τ > zero Pivot Point

CS Real Arm Linkage Torque F L Joint Motor Pivot Point (Use maximum (holding) torque case) L WL WM Real motors and linkages have mass and therefore weight under gravity Assume linkage mass is evenly distributed and the weight is located at the centre of the linkage length Weight Motor Weight Linkage

CS Arm Joint Motor Torque Calculations L3 L2 L1 WP WL1 WL2 WL3 WM1WM2 τM1= (WP × L1) + (WL1 × (0.5 × L1)) τM2= (WP × (L1 + L2)) + (WL1 × ((0.5 × L1) + L2)) + (WM1 × L2) + (WL2 × (0.5 × L2)) τM3= (WP × (L1 + L2 + L3)) + (WL1 × ((0.5 × L1) + L2 +L3)) + (WM1 × (L2 + L3)) + (WL2 × ((0.5 × L2) + L3)) + (WM2 × L3) + (WL3 × (0.5 × L3)) Payload M1M2 M3

CS Motor Torque Calculation Example τM1 = Nm τM2 = Nm τM3 = Nm Titan gravity1.373 m/sec 2 Payload mass2.0 kg Linkage L1 length0.3 m Linkage L2 length0.5 m Linkage L3 length0.6 m Mass of Linkage L10.5 kg Mass of Linkage L20.8 kg Mass of Linkage L30.9 kg Mass of Joint Motor kg Mass of Joint Motor kg Based upon arm configuration shown in the previous slide, calculate the three motor torques, i.e. τM1, τM2, and τM3, using the parameters in the table below:

Gear Box Selection: a)A gear box will be needed to achieved desired output motor torque b)Gear Box Torque Ratio is ratio of output torque to input torque, e.g. 100:1, 1000:1 etc. c)E.g. for τM3 select 73.1 × Nm × 100:1 = 7.31 Nm CS

Final Points Maximum holding torques calculated for each motor. Would need to add contingency (e.g. 20%) for each motor. Calibration, motion selection, and motor torques also apply to a rover locomotion chassis, i.e. steering and drive mechanism Same techniques can be applied, but chassis details not covered here CS