3/9/11

Manipulator Dynamics: Two Degrees-of-freedom

Manipulator Dynamics

Objective: Calculate the torques necessary to overcome dynamic effects

Consider 2 dimensional example

Based on Lagrangian approach

The Lagrangian

Generalized coordinate Torque or force

3/9/11

For Mass M1

For mass M2, the Cartesian coordinates are

The velocities are

The velocity squared

Thus:

Note:

And the kinetic energy

The Lagrangian is then

3/9/11

Differentiating the Lagrangian for T1

Thus on joint 1, the torque is

Differentiating the Lagrangian for T2

The torque on joint 2 is then

3/9/11

Inertial or sensitivity matrix

Centripetal matrix

Effective inertias

Coupling inertias D12 = D21

Centripetal forces acting on joint i due to a velocity at joint j

D111 = D222 = 0 & D122 = D211

Coriolis forces acting on joint i due to velocities at joints j & k

D112 = D121 & D212 = D211

Manipulator Dynamics: Multiple Degree-of-freedom Systems

3/9/11

In general, the dynamic equation for a manipulator in terms of a six dimensional displacement vector q

(6 joints, 7 links and a gripper) is

= 6 x 6 inertia matrix

= 6 x 6 viscous friction matrix

= 6 x 1 vector defining Coriolis and

centrifugal forces

= 6 x 1 vector defining the gravity terms

= 6 x 1 vector of input generalized forces

Bottleneck

Computation of joint torques in order to maintain joint positions, velocities, and accelerations

Variety of methods used, based on:

◆  Lagrangian techniques

◆  Newton-Euler Formulation

◆  Table look-up approaches

3/9/11

Computation of Joint Torques

Fastest Approach:

Table look-up approach, but large� memory requirement

Most reasonable approach to date:

Iterative form of Newton Euler with dynamics referred to links’ internal coordinate system� (Luh, Walker & Paul, 1980)

In 1980, solution for 6 DOF manipulator� on PDP11/45 with floating point:

Assembly language: 4.5 msec FORTRAN: 33.5 msec (too slow)

Inertial effects of drive and transmissions on dynamics

3/9/11

Effect of Activator/Drive on Inertial Effects:

(Ignoring compliance and dissipative losses)

JL Equiv= Equivalent inertia of load & motor/transmission on load shaft

Typically

Thus may contribute a large constant inertia to the overall effective inertia … reducing the inertial variation somewhat.

Effect on Structural Natural Frequency:

Subscripts:

a: actual

o: measured at� some configuration

As the inertial effect increases the natural frequency decreases (as the square root)

(Speed Reduction & Torque Increase)

3/9/11

However

Note that as is reduced

For: - Speed Reduction

- Torque Increase

- Reduction of loading variations (TL) applied to the motor

The power requirement for a given ωL increases dramatically

Power required for motor= P = Tmωm

therefore This limits the minimum ratio that can be selected

when

Harmonic Drives ◆  See http://www.harmonicdrive.net/

◆  1955: Invented by C. Walton Musser ◆  1958: Harmonic Drive developed at United Shoe

Machinery Corp. Research Division. Patent issued ◆  1960: Harmonic Drive Div’n formed under United

Shoe Machinery, later changed to USM Corp. ◆  1991: Harmonic Drive Technologies acquired by

Teijin Seiki Ltd. ◆  2003: Teijin Seiki Ltd and Nabco Corporation Ltd

combine to form Nabtesco Corporation and Harmonic Drive Technologies, Teijin Seiki Boston Inc becomes Harmonic Drive Technologies, Nabtesco Incorporated

◆  2006: HD Systems, Inc. and Harmonic Drive Technologies, Nabtesco Inc. formed joint company named Harmonic Drive LLC to market and support product.

3/9/11

HARMONIC DRIVE DEFINITIONS�

◆  Cup sets consist of three components a flexspline, circular spline and a wave generator bearing.

◆  Flexspline�A non-rigid or flexible, thin-walled, cylindrical cup with external teeth. It has two less teeth than the Circular Spline

◆  Circular Spline�A round , rigid ring with teeth on the internal spline that contact the teeth on the outside of the Flexspline. It is normally fixed but can be used as the output.

◆  Wave Generator�The Wave Generator is an elliptical ball bearing assembly. It normally functions as the input. It is inserted into the Flexspline causing the external teeth of the Flexspline to engage with the internal teeth of the Circular Spline at two equally spaced areas 180 degrees apart.

Elliptical wave generator�(a ball bearing assembly) input deflects Flexspline to engage teeth at the major axis

Flexspline teeth at minor axis are fully disengaged – most of the relative motion occurs here

Flexspline output rotates in opposite direction to input

Rigid circular spline is rotationally fixed with a rigid internal gear

Deflections are greatly exaggerated

3/9/11

The teeth on the non-rigid Flexspline and the rigid Circular Spline are in continuous engagement.

Since the Flexspline has two teeth fewer than the Circular Spline, one revolution of the input causes relative motion between the Flexspline and the Circular Spline equal to two teeth.

With the Circular Spline rotationally fixed, the Flexspline rotates in the opposite direction to the input at a reduction ratio equal to one-half the number of teeth on the Flexspline.

All tabulated Harmonic Drive gear reduction ratios assume output through the Flexspline with the Circular spline rotationally fixed. However, any drive element may function as the input, output, or fixed member.

For other videos, see youtube.com. For example, … http://www.youtube.com/watch?v=q1v7a0jsp1I

Natural preload provides zero backlash: Deflection of the round, free-state cup Flexspline into an elliptical shape at its open end results in non-parallel gear teeth along the major axis. However, the teeth when engaged with the Circular Spline are returned to parallel, thereby creating a natural pre-load condition, The result is minimal backlash.

3/9/11

Cyclo Drives

◆  Rolling gear action Planocentric Trochoidal (cycloidal) Gear Drives, or CYCLOs for short. Properties: –  Large reduction in 1 stage –  Smooth and high performance –  High reliability, long service life –  Excellent shock absorption, reduced friction –  Compact and high power –  Up to 500% overload capacity –  Low to zero backlash.

◆  Lorenz Braren invented the Cyclo gearbox and founded Cyclo Getriebebau GmbH in Munich, Germany, in 1931.

◆  The Cyclo is a speed reducer without a high speed pinion or gear teeth; it does not operate in shear but in compression Benefit: No catastrophic failure.

◆  In 1974, Sumitomo Heavy Industries, acquired an interest in Cyclo Getriebebau GmbH.

◆  In 1994, Sumitomo bought the German company outright.

◆  See http://www.smcyclo.com

How it Works

◆  The Cyclo speed reducing system is based on only three major moving parts: –  High speed input shaft with an integral eccentric cam

and roller bearing assembly –  Cycloid discs –  Slow speed output shaft assembly

◆  As the input shaft and eccentric cam rotate, it rolls the cycloid discs around the internal circumference of the stationary ring gear.

◆  Resulting action is similar to that of a wheel rolling around the inside of a ring.

◆  As the cycloid disc travels in a clockwise path around the ring, the wheel itself turns slowly on its own axis in the opposite (counter clockwise) direction.

◆  Because of the curved, cycloidal profile of the cycloid disc, it progressively engages with the rollers of the ring gear housing to produce a reverse rotation at reduced speed.

◆  For each complete revolution of the high speed shaft, the cycloid disc turns one cycloidal "tooth" in the opposite direction.

◆  The reduced rotation of the cycloid disc is transmitted to the slow speed output shaft to provide - speed reduction.�

◆  See “Cyclo in action” (series of videos) at http://www.smcyclo.com

3/9/11

Why it's Better�(from Cyclo literature)�

◆  The smooth, progressive rolling action of the cycloidal disc speed reduction mechanism eliminates friction and the pressure points of conventional gears.

◆  All of the Cyclo's torque transmitting components roll, and are symmetrically placed around the shafts for balanced, smooth, vibration free and quiet operation.

◆  Because the components are in compression, they cannot shear off like traditional gear teeth.

◆  Consider sample CYCLO of: - 18-roller ring gear (blue), two 17-lobe cycloid discs

(gray & black), an 8-roller planocentric ring gear or “spider”(green), and an eccentric shaft (cyan) with two eccentric portions (magenta) - shown at home position in the left layout in the box below.

◆  Each disc is supported radially by its own antifriction bearing (yellow) and eccentric.

◆  The right layout in the box shows the same unit at home position with the gray disc and the corresponding bearing and eccentric removed, for illustrating the 180 degree angle between the two eccentrics.

◆  The eccentric shaft, ring gear shaft, and spider shaft are coaxial.

Eccentric shaft: