2 backlash simulation

Post on 15-Jul-2015

572 Views

Category:

Science

5 Downloads

Preview:

Click to see full reader

Transcript

1

Backlash Simulation

SOLO HERMELIN

Updated: 26.11.06 25.02.11

No Backlash Backlash

http://www.solohermelin.com

2

SOLO Backlash

Introduction

Two masses interacting with translational motion inside a moving vehicle

Backlash Mathematical Model

Spur GearMotor Moment Equation

Load Moment EquationContact MomentBacklash Error

Backlash Logic

MATLAB ProgramSimulation Results

References

Teeth Collision

3

SOLO Backlash

Gears are used to transmit torque between rotating axes using teeth. In a perfect Gear System, the tooth of one axis Gear is always in Contact with the tooth of the Gear of the other axis.

Because of production tolerances, during the rotation the teeth Contact is lost for a small angle, until is reestablished. This is the Gear Backlash.

4

SOLO Backlash

To develop the Backlash model we must deal with the following cases:

Because of production tolerances, during the rotation the teeth Contact is lost for a small angle, until is reestablished. This is the Gear Backlash.

(1) No Contact between the teeth of the two axes.

In this case the rotation dynamics of each axis is independent.

(2) Contact between the teeth of the two axes is just established.

In this case an equal impulse is transferred between the teeth in Contact that will produce a change in angular velocity of the two axes.

(3) A Continuous Contact between mating teeth exists. In this case the rotation rate of the two axes is coupled and defined by the Gear Teeth Ratio. The Moments transferred between the two axes are such that the rotation rates and rotation accelerations are coupled.

(4) Contact Lost (Disengagement), when the mating teeth lose Contact.

To get a understanding of the Backlash that involves rotation of two axes let start with a simpler example of one dimensional translation of two body that interact inside a moving vehicle, as seen in the Figure. Return to the Table of Content

5

SOLO Backlash

Consider a simple example (one dimensional translation) of a vehicle moving with a known velocity VB (t). Inside the vehicle we have two masses: 1. m1 of coordinate x1 on which an external force F1 is applied 2. m2 of coordinate x2 on which an external force F2 is applied

When the masses are in contact a internal force F12, between the two masses, applies.

We can see that we have the physical constraint: - δBL ≤ x2-x1 ≤δBL

Two Masses Interacting with Translational Motion inside a Moving Vehicle

6

SOLO Backlash

Equations of Motion

1. No contact between m1 and m2

( )

( )BLBL

BD

BD

xx

VFFm

x

VFFm

x

δδ <−<−

−−=

−−=

12

22

2

11

1

2

1

1

1

2. Contact between m1 and m2

( )

( )BL

BD

BD

xx

VFFFm

x

VFFFm

x

δ±=

−−−=

−−+=

12

1222

2

1211

1

2

1

1

1

21, FF - known applied forces on m1 and m2, respectively

21, DD FF - known disturbance forces on m1 and m2, respectively

( ) ( )21

122112

12

mm

FFmFFmxx DD −−−

=−

( ) ( )BL

DD xxFmm

mm

mm

FFmFFmxx δ±=+−

−−−=− 1212

21

21

21

121112

12

Two Masses Interacting with Translational Motion inside a Moving Vehicle

7

SOLO Backlash

Equations of Motion (continue – 1)

At collision between m1 and m2 a transfer of linear impulse ΔP occurs between the two masses

( )( ) ( )( )[ ] ( )( ) ( )( )[ ]( ) ( )[ ] ( ) ( )[ ]−−+−=−−+=

−+−++−=−+−++=∆=∆

222111

22211112

xxmxxm

xVxVmxVxVmtFP BBBB

or

( ) ( )[ ] ( ) ( )[ ] 0222111 =−−++−−+ xxmxxm

The second equation is obtained by using the elastic coefficient of collision e (e = 0, for plastic collision and e =1 for an elastic collision), that is defined as:

We obtain one equation with two unknowns ( ) ( )++ 21 , xx

( ) ( )( ) ( )

( )[ ] ( )[ ]( )[ ] ( )[ ]−+−−+

++−++−=−−−+−+−=

21

21

21

21:xVxV

xVxV

VV

VVe

BB

BB

( ) ( )( ) ( )−−−

+−+−=21

21

xx

xxe

or

We have x2 = x1 - δBL if before contact (-) ( ) ( ) 012 <−−− xx

We have x2 = x1 +δBL if before contact (-) ( ) ( ) 012 >−−− xx

2. Contact between m1 and m2 (continue – 1)

Two Masses Interacting with Translational Motion inside a Moving Vehicle

8

SOLO Backlash

Equations of Motion (continue – 2)

Now we have two equations with two unknowns:

or

Solving for , we obtain:( ) ( )++ 21 , xx

( ) ( ) ( ) ( ) ( ) ( )−++−−=++ 22121121 1 xmexemmxmm

( ) ( ) ( ) ( ) ( ) ( )−−+−+=++ 21211221 1 xemmxmexmm

( ) ( ) ( )( ) ( ) ( )[ ]−−−

+++−=+ 12

21

211

1xx

mm

mexx

( ) ( ) ( )( ) ( ) ( )[ ]−−−

++−−=+ 12

21

122

1xx

mm

mexx

2. Contact between m1 and m2 (continue – 2)

( )( ) ( ) ( )[ ]−−−

++=∆=∆ 12

21

2112

1xx

mm

mmetFP ( ) ( )[ ] ( ) ( )[ ]−−+−=−−+=∆=∆ 22211112 xxmxxmtFP or

1F

2m

1x

2x

BV

1m

BLδ

1 2P∆P∆

BLδ

0&12 >∆=− Pxx BLδ

2F

( ) ( ) ( ) ( )( ) ( ) ( ) ( )−−−=+−+

−+−=+++

1221

22112211

xexexx

xmxmxmxm

Two Masses Interacting with Translational Motion inside a Moving Vehicle

9

SOLO Backlash

Equations of Motion (continue – 3)

( ) ( )

BL

aa

DD

xxa

Fmm

mm

mm

FFmFFmxx

δ±≠=∆

+−−−−

=−

12

1221

21

21

122112

0

12

2. Contact between m1 and m2 (continue – 3) Let solve at contact x2 = x1 +δBL

( ) 00 >−∆ x

Let assume, for simplicity, that during contact phase: 0>= consta

We have:

( ) ( ) 000 <−∆−=+∆ xex

( ) ( ) ( )−∆−=+∆+=∆ 00 xeatxattx

( ) ( )−∆−=∆ 02

1 2 xetattx

Next contact

( ) ( ) 00112

11 2 =−∆−=∆ xeTaTTx

( )e

a

xT

∆−∆= 0

21

( ) ( ) ( ) ( )−∆=−∆−−∆=−∆ 000

21 xexeaea

xTx

( ) ( ) ( ) 0011221

21 >−∆+=+=∆ txeFmm

mma δ

Two Masses Interacting with Translational Motion inside a Moving Vehicle

10

SOLO Backlash

Equations of Motion (continue – 4) 2. Contact between m1 and m2 (continue – 4) Second contact

( ) ( ) 00112

11 2 =−∆−=∆ xeTaTTx

( )e

a

xT

−∆= 021

( ) ( ) ( ) ( )−∆=−∆−−∆=−∆ 000

21 xexeaea

xTx

Third contact

( ) 211

22 eTea

TxT =−∆=

( ) ( ) ( )−∆=−∆=−∆ 012 2 xeTxeTx

(n+1)th contactneTTn 1=

( ) ( )−∆=−∆ 0xeTnx n

We can see that, if e < 1, the time between two successive contacts converge to zero and the two bodies stacked together.

( )e

eTeTTnTTT

nn

n −−=++=+++=

+

1

111121

1

Two Masses Interacting with Translational Motion inside a Moving Vehicle

12 xxx −=∆a

12 xxx −=∆

BLδ

1T 2T 3T12 TeT = 13 TeT =

( ) txeatx −∆−=∆ 02

1 2

( )e

a

xT

−∆= 021

12 xxx −=∆

( )−∆ 0x

( )−∆− 0xe

( ) ( )−∆=−∆ 01 xeTx

( )−∆− 1Txe

( ) ( )−∆=−∆ 12 TxeTx

( )−∆− 2Txe

( )−∆−=∆ 0xeatx

( ) ( ) ( )txea δ−∆+−=∆ 011 12 aea ∆=∆ 223 2 aeaea ∆=∆=∆

11

SOLO Backlash

Equations of Motion (continue – 5)

12 xxx −=∆a

12 xxx −=∆

BLδ

12 xxx −=∆

( )−∆ 0x

( )−∆− 0xe The two massesstick together

2. Contact between m1 and m2 (continue – 5)

We can see that, if e < 1, the time between two successive contacts converge to zero and the two bodies stacked together.

If we assume e = 0, the masses stick together instantaneously and we obtain:

( ) ( ) 000 =−∆−=+∆ xex

When we perform a numerically computationwe have for some n:

teTTn n ∆≤= 1

where Δt is the integration step, and then wewill encounter a numerical problem. Therefore we must assume that the masses stick together before this happens.

( ) ( ) 001221

21 >−∆=+=∆ txFmm

mma δ

Two Masses Interacting with Translational Motion inside a Moving Vehicle

( )e

eTeTTnTTT

nn

n −−=++=+++=

+

1

111121

1

12Serway and Jewett,“Physics for Scientists and Engineers”, 6th Ed.,

13

SOLO Backlash

Equations of Motion (continue – 6)

Let see what are the equation of motion when the two masses stick together ( x1(t) = x2 (t) for a nonzero period of time).

In this case

( )

( )

−−−=

−−+=

BD

BD

VFFFm

x

VFFFm

x

2

1

1222

1

1211

1

1

1( )

( ) ( )( )21

1222112

21

22121

1

1

mm

FFmFFmF

Vmm

FFFFxx

DD

BDD

+−−−

=

−+

−−+==

From the Figures bellow the masses will stick together as long as ( ){ } 01212 >−⋅ xxFsign

Two Masses Interacting with Translational Motion inside a Moving Vehicle

14

SOLO Backlash

Equations of Motion (continue – 7)

1F

1DF

12F

12F

2DF

12F

2F

( ) ( ) ( )( ) ( ) ( )[ ]−−−

++−−=+ 12

21

122

1xx

mm

mexx

2

1

m s

1

s

1

BV

2x

BL

( ) ( ) ( )( ) ( ) ( )[ ]−−−

+++−=+ 12

21

211

1xx

mm

mexx

1

1

m s

1

s

1

BV

1x

BL

( ) ( ) ( ) ( )1121

22

21

12 DD FF

mm

mFF

mm

m −+

−−+

2x

12 xx −

BL1

0 12 xx −

BLδBLδ−1x

2x

12F( )121 2 xxF −

1 ( )[ ]1212 xxFsign −

AND

BL

Stickmode

Two Masses Interacting with Translational Motion inside a Moving Vehicle

Return to the Table of Content

15

SOLO Backlash

Backlash Mathematical Model

Motor Moment Equation

m

DmrmCTBm J

TTiK −−+= ωθ

( )

InertiaMotor

Bmm

eDisturbanc

Dm

Torquection

rm

CommandTorque

put

CT JTTiK ωθ −=−−ReIm

- command currentCi- moment of inertia of the rotor along it’s rotational axis mJ- rotor gear angle and it’s first and second order derivativemmm θθθ ,,- angular rate and acceleration of the bodyBB ωω ,- reaction torque of the gimbals gear on the rotor gearrmT-disturbance torque on the rotor (friction, mass-unbalance, inertia cross-coupling) – not a function of

DmTmθ

Return to the Table of Content

16

Spur Gear Nomenclature

Pitch circles – Theoretical circles upon which all calculations are based with centers O1 and O2 and diameters D1 and D2.

The two pitch circles are tangent at the pitch point P.

Pressure Lines – The lines passing through P and making

an angle φ with the tangent to the pitch circles along which the tooth of one gear presses the tooth of the second gear.

Base circles – Circles tangent to pressure line with centers O1 and O2 and diameters

DB1 and DB2.

ϕϕ cos&cos 2211 DDDD BB ==

Circular pitch p – The distance measured along the pitch circle from a point on one tooth to the

corresponding point on the adjacent point. Since we assume that the two

gears always maintain contact during rotation the circular pitches are equal.

N1, N2 – Number of teeth on the two gears.

ω1, ω2 – Angular rates of the two gears.

2211 ωω NN =

2

2

1

1

N

D

N

Dp

ππ ==

1

2

2

1

2

1

ωω==

N

N

D

D

SOLO

Pitch Circles

P

O 1

O 2

R 1

R 2

BaseCircles

ϕR B1

R B2

ϕ

PressureLine 1Pressu

re

Line 2

17

A

Begincontact

Endcontact

BCContact Line 1

(Involute)

A'

B'Contact Line 2

(Involute)

rFPressure

Line 1

PressureLine 2

ReactionForce

rF

ReactionForce

Spur Gear Teeth

Spur Gear Tooth shape must be such that contact between the tooth of one gear to thecorresponding tooth of the second gear iscontinuously maintained until the contact occurs with the adjacent tooth.

If the shapes of the teeth on the two gearshave this property they are called conjugates.

From the figure we can see that during therotation of the driver the contact begins atpoint A and continues until it ends at point B.

The segment AB is on the pressure line.

Among infinite possibilities of conjugateshapes the one that is almost exclusively usedin the gear design is the involute.

SOLO

18

Spur Gear Teeth

Among infinite possibilities of conjugateshapes the one that is almost exclusively usedin the gear design is the involute.

The involute of a circle (base circle) is obtainedby an imaginary string IA (see Figures) wound on

the circle and then unwounded (IC, IB(, while holding it taut.

Base circleO

β

I

θ ψA

β1BR

β1BR

r

x

y

Cθ Cr

( )θ,rB

( )CCrC θ,

( )( )βββ

βββcossin

sincos

1

1

−=+=

B

B

Ry

Rx

The involute equation

The involute has the following properties:

1. All lines normal to the involute are tangent to the base circle

2. The radius of curvature of the involute at a point P (r,θ) is given by ρ=RB1β. The base circle is the locus of the center of curvature

of the involute.

SOLO

19

Spur Gear Teeth

In the same way

Point A on the involute has the radius RA and thethickness tA along the circle RA.

SOLO

AB

AR

BR

bRAφ

2/Bt2/At

O

E

D

FG

toothinvolute

base circle

B

involute

OG

BG

OG

DGDOG φtan===∠

BBBB invDOGDOB φφφφ =−=−∠=∠ :tan

AAA invDOA φφφ =−=∠ :tan

Point B on the involute has the radius RB and thethickness tB along the circle RB.

A

A

AA

A

R

tinv

R

tDOADOE 2

121

+=+∠=∠ φ

B

B

BB

B

R

tinv

R

tDOBDOE 2

121

+=+∠=∠ φ

−+= BA

B

ABB invinv

R

tRt φφ

22

soloh, 07/18/2005
Hamilton H. Mabie and Fred W. Ocvirk"Mechanics and Dynamics of Machinary" SI version3th edition, pp.98-99

20

Width ofspace

Face width

Top land

Addendumcircle

Tooth

thicknessAddendum

Dedendum

Dedendum

circle

Clearencecircle

Clearence

Pitch

circle

Face

Flank

Bottom la

nd

Spur Gear Teeth SOLO

Addendum – the radial distance between the top land of the tooth and the pitch circle

Dedendum – the radial distance between the bottom land of the tooth and the pitch circle

Addendum circle – the circle passing through the top land of the tooth

Dedendum circle – the circle passing through the bottom land of the tooth

Clearance circle – the circle tangent to the addendum of the mating gear

21

Spur Gear Force Equation SOLO

If no backlash rmθm = rLθL

Lm

Lm r

r θθ

=

load

L

motor

m

N

D

N

Dp

ππ ==

Mating condition of the teeth on the two gears is

Circular path of gear 1 = Circular path of gear 2

L

motor

load

m

L

m

L NN

N

D

D

r

r === :LLL

motor

loadL

m

Lm N

N

N

r

r θθθθ =

=

=

The force applied by gear 1 on gear 2 is Fr . Since the tooth surface shape is an involute and the force at the point of contact is normal to the surface, it will be tangent to the base circle that defines the involute. Therefore Fr will always be on the pressure line and

tangent to both base circles.

ϕϕ cos

3'

cos L

th

m r

bL

rLLawsNewton

r

r

bm

rm

r

TF

r

T ==

L

rLrL

L

mrL

L

mrm N

TT

N

NT

r

rT ===

Pressure line 1

Base circle

Pitch circle

Pitch circleBase circle

P B

Pinion(driver)

Gear(driven )

C

O1

ϕBegin

contact

EndcontactA

rF

rF

bmrmr

bLr

Lr

ϕ

ϕ

Trm, TrL are the reaction moments on the two gears

Return to the Table of Content

22

SOLO Backlash

Load Moment Equation

( ) LDLBmL

LLDLBLLrmLLm TTN

JTTJTNT ++

+=+++== ωθωθ 1

- moment of inertia of the load (including all the parts attached to it) along it’s rotational axis

LJ

- load gear angle and it’s first and second order derivativeLLL θθθ ,,

- torque applied by the motor gear on the load gearrLTwhere

-disturbance torque on the load (friction, mass-unbalance, inertia cross-coupling) – not a function of

DLTLθ

- torque applied on the load gearLT

L

LDLrmLBL J

TTTN −−+−= ωθ or

Return to the Table of Content

23

SOLO Backlash

From this equation we can find the moment Trm necessary to stick the motor gear to the gimbals gear is:

L

LDLBB

m

DmrmCT

LL

L

L

rLrm N

TT

J

TTiK

NN

J

N

TT

++

+

+−−== ωω

1

( )[ ] ( )2

2

1

11

1

LmL

LDLmLBLmDmCTL

Lm

L

L

LDLBB

m

DmCT

LL

L

rm

NJJ

TTJNNJTiKJ

NJJ

N

TT

J

TiK

NN

J

TSTICK

+++++−=

+

++

+

+−

=

ω

ωω

m

DmrmCTBm J

TTiK −−=−ωθ

L

LDLrmLBL J

TTTN −−=+ωθ

Contact Moment

Return to the Table of Content

24

SOLO Backlash

Define the backlash error

LLmBL N θθε −=:

Then

BLBLIF θε < 0=rmT 0== rmLrL TNT

BLBLIF θε ≥STICKrmrm TT = rmLrL TNT =

Backlash Error

Return to the Table of Content

25

SOLO Backlash

Let find what happens at the collision of the teeth of the gears.

( ) →−== trV BmmOmM

I

M 1ωθρ

The velocity at the point M on the motor gear is:

The velocity at the point L on the load gear is:

( ) ( )( ) →

→→

−=

+++−=+=

trr

trtrrV

BmLL

BLLBLmLO

I

OO

I

L LLm

1

11

ωθ

ωθωρρ

Teeth Collision

(1) No Contact between the teeth of the two axes.

In this case the rotation dynamics of each axis is independent.

26

SOLO Backlash

The collision between toot M and L will produce an equal and opposite impulse Pr on the gear tooth, that will produce reaction impulses on the gear axes, and a change in angular impulse on both gears (ΔHm, ΔHL)

( )[ ] ( )[ ]( ) ( )[ ] mrmmm

BmmBmmm

rPJ

JJH

∆−=−−+=

−−−−+=∆

θθωθωθ

( )[ ] ( )[ ]( ) ( )[ ] LrLLL

BLLBLLL

rPJ

JJH

∆=−−+=

+−−++=∆

θθωθωθ

( ) ( )−− Lm θθ , and are the angular rates of the motor and gimbals gears, respectively, before (-) and after(+) the collision.

( ) ( )++ Lm θθ ,

We obtain the following equations

( ) ( )[ ] ( ) ( )[ ]−−+−=−−+=∆ mmmm

LLLL

r Jr

Jr

P θθθθ 11

Teeth collision (continue – 1)

27

SOLO Backlash

The second equation is obtained by using the elastic coefficient of collision e (e = 0, for plastic collision and e =1 for an elastic collision), that is defined as:

( ) ( )[ ] ( ) ( )[ ]−−+−=−−+=∆ mmmm

LLLL

r Jr

Jr

P θθθθ 11

or

( ) ( )[ ] ( ) ( )[ ] 0=−−++−−+ mmmLLLL JNJ θθθθ

We obtain one equation with two unknowns ( ) ( )++ Lm θθ ,

( ) ( )( ) ( )

( )[ ] ( )[ ]( )[ ] ( )[ ]

( ) ( )( ) ( )

( ) ( )( ) ( )−−−

+−+−=−−−+−+−=

−−−−−−+−−+−=

−−−+−+−=

mLL

mLL

mmLL

mmLL

BmmmBmLL

BmmmBmLL

ML

ML

N

N

rr

rr

rrrr

rrrr

VV

VVe

θθθθ

θθθθ

ωθωθωθωθ

:

Teeth collision (continue – 2)

28

SOLO Backlash

or:

Now we have two equations with two unknowns ( ) ( )++ Lm θθ ,

( ) ( ) ( ) ( )( ) ( ) ( ) ( )

−−−=+++−

−+−=+++

LLmLLm

LLmmLLLmmL

eNeN

JJNJJN

θθθθθθθθ

Solving for we obtain( ) ( )++ Lm θθ ,

( ) ( ) ( ) ( ) ( ) ( )( ) ( ) ( ) ( ) ( ) ( )−−+−+=++

−++−−=++

LmLLmmLGmLL

LLLmLmLmmLL

JNeJJNeJNJ

JNeJeJNJNJ

θθθ

θθθ

22

22

1

1

( ) ( ) ( )( ) ( ) ( )[ ]−−−

++−−=+ LLm

mLL

Lmm N

JNJ

Je θθθθ 2

1

( ) ( ) ( )( ) ( ) ( )[ ]−−−

+++−=+ LLm

mLL

mLLL N

JNJ

JNe θθθθ 2

1

Teeth collision (continue – 3)

Also

( ) ( )[ ] ( ) ( ) ( )[ ]−−−+

+=−−+−=∆=∆ LLm

mLL

Lmmmmmrrm N

JNJ

JJeJrPtT

Cθθθθ

2

1

29

SOLO Backlash

Let compute ( ) ( )+−+ LLm N θθ

( ) ( ) ( )( ) ( ) ( )[ ]−−−

++−−=+ LLm

mLL

Lmm N

JNJ

Je θθθθ 2

1

( ) ( ) ( )( ) ( ) ( )[ ]−−−

+++−=+ LLm

mLL

mLLL N

JNJ

JNe θθθθ 2

1

Teeth collision (continue – 4)

( ) ( ) ( )( )

( )( ) ( ) ( )[ ]−−−

+

+−++−=+−+ LLm

mLL

mL

mLL

LLLm N

JNJ

JNe

JNJ

JeN θθθθ

2

2

2

111

or

( ) ( ) ( ) ( )[ ]−−−−=+−+ LLmLLm NeN θθθθ

We can see that

( ) ( )[ ] ( ) ( )[ ]−−−−=+−+ LLmLLm NsignNsign θθθθ

30

SOLO Backlash

LLmBL N θθε −=

θa

BLθ

1T 2T 3T12 TeT = 13 TeT =

( ) teat BLBL −−∆= 02

1 2 εε

( )e

aT BL

∆−= 0

21ε

( )−0BLε

( ) ( )−+−=∆ 011 BLea εθ

12 θθ aea ∆=∆23 θθ aea ∆=∆

LLmBL N θθε −=

( )−− 0BLe ε( )−− 1Te BLε ( )−− 2Te BLε

( ) ( )−=− 12 TeT BLBL εε

( ) ( )−=− 01 BLBL eT εε

LLmBL N θθε −=

( )−−= 0BLBL eat εε θ

Let solve at collision

( ) 00 >−BLε

Let assume, for simplicity, that during contact phase: 0>= constaθ

We have:

( ) ( ) 000 <−−=+ BLBL e εε

( ) ( ) ( )−−=++= 00 BLBLBL eatatt εεε θθ

( ) ( )−−= 02

1 2BLBL etatt εε θ

Next contact

( ) ( ) 00112

11 2 =−−= BLBL eTaTT εε θ

( )e

aT BL

θ

ε −= 021

( ) ( ) ( ) ( )−=−−−=− 000

21 BLBLBL

BL eeaea

T εεεε θθ

Teeth collision (continue – 5)

L

LDLrmLBL J

TTTN −−+−= ωθ

m

DmrmCTBm J

TTiK −−+= ωθ

( ) ( ) ( )teTJJ

JNJ

TJJ

JNJT

JJ

JNJN

BL

a

rmmL

mLL

rmmL

mLLrm

mL

mLLLLmBL

STICK

STICK

δε

θθε

θ

−+−+=

+−+=−=

012

22

31

SOLO Backlash

The kinetic energy loss due to the collision is given by

( ) ( ) ( ) ( )2

2222

2

1

2

1

2

1

2

1

+++−

−+−=∆ LLmmLLmmk JJJJE θθθθ

( ) ( )

( ) ( )( ) ( ) ( )[ ]

( ) ( )( ) ( ) ( )[ ]

2

2

2

2

22

1

2

1

1

2

1

2

1

2

1

−−−+

++−−

−−−++−−−

−+−=

LLm

mLL

mLLL

LLm

mLL

Lmm

LLmm

NJNJ

JNeJ

NJNJ

JeJ

JJ

θθθ

θθθ

θθ

( )( ) ( ) ( )[ ] ( ) ( )[ ]

( )( ) ( ) ( )[ ] ( )mLLLLm

mLL

mL

LLmLLm

mLL

mL

JNJNJNJ

JJe

NNJNJ

JJe

22

22

2

2

2

1

1

+−−−+

+−

−−−−−−+

+−=

θθ

θθθθ

( )( ) ( ) ( )[ ]2

2

2

2

1 −−−+

−= LLm

mLL

mL NJNJ

JJe θθ

Teeth collision (continue – 6)

32

SOLO Backlash

The kinetic energy loss due to the collision is given by

( )( ) ( ) ( )[ ]2

2

2

2

1 −−−+

−=∆ LLm

mLL

mLk N

JNJ

JJeE θθ

We can see that

1. If (soft touch) then( ) ( )−=− mLLN θθ

( ) ( )−=+ mm θθ

( ) ( )−=+ LL θθ

0=∆ kE

2. If e = 1 (elastic collision)

0=∆ kE 3. The maximum kinetic energy loss is obtained when e = 0 (plastic collision)

( ) ( ) ( )[ ]2

22−−−

+=∆ LLm

mLL

mLk N

JNJ

JJE

MAXθθ

Teeth collision (continue – 7)

Return to the Table of Content

33

SOLO Backlash

The backlash of two gears occurs because of thermal expansion and tooth error at predefined angles. When backlash occurs the two gears loose contact for a small angle.

For gear1 the lose of contact occurs every radians.1

1

2

N

π=Θ

For gear2 the lose of contact occurs every radians.2

2

2

N

π=Θ

11

2

N

π=Θ

22

2

N

π=Θ

12 Θ 13 Θ14 Θ

24 Θ

23 Θ

22 Θ

2θ2

2

12 θθ

N

N=

1Θ−

2Θ−

BLθ2

Backlash Logic

34

SOLO Backlash

Backlash Logic (continue - 1)

IF Backlash = .True. & Gears dynamically independent BLk θθ ≤Θ− 11

IF Backlash = .False. & Gears stick togetherBLk θθ >Θ− 11

No Backlash Backlash

35

SOLO BacklashBacklash Logic (continue - 2)

A

C C’

Contact Line1

(Involute)

Contact Line2

(Involute)A’0>rF 0<rF

Each tooth has two contact lines:

Contact line 1 between points A and CContact line 2 between points A’ and C’

Contact line 1 of gear 1 (G1) touchescontact line 1 of gear 2 (G2) along thepressure line 1. To keep the contact wemust have Fr > 0 (the reaction force between G1 and G2).

Contact line 2 of gear 1 (G1) touchescontact line 2 of gear 2 (G2) along thepressure line 2. To keep the contact wemust have Fr < 0 (the reaction force between G1 and G2).

On pressure line 1 if 210 GG →>θ

120 GG →<θ

On pressure line 2 if 120 GG →>θ

210 GG →<θ

Gear Gi pushes gear Gj GjGi →

36

SOLO Backlash

Dynamic computations in contact

Compute

Contact Flag = .True.

[ ]mr

LmL

DLmLBmDmCTLrm rF

NJJ

TJNJTiKJT

STICK=

+++−= 2

ω

m

DmrmCTBm J

TTiK −−=−ωθ

L

LDLrmLBL J

TTTN +−=+ωθ

Integrate both equations to obtain

BLBm ωθωθ +− ,

Compute and integrate to obtainLm θθ , Lm θθ ,

Backlash Logic (continue - 3)

37

SOLO Backlash

Dynamic computations in contact (second way)

Compute

Contact Flag = .True.

[ ]mr

LmL

DLmLBmDmCTLrm rF

NJJ

TJNJTiKJT

STICK=

+++−= 2

ω

B

m

DmrmCTm J

TTiK ωθ +−−

=

B

L

LDLrmLL J

TTTN ωθ −+−

=

Integrate both equations to obtain

Lm θθ ,

and integrate to obtain Lm θθ ,

Backlash Logic (continue - 4)

38

SOLO Backlash

Detection of End of Contact

Contact ends if one of the following condition occurs

Backlash Logic (continue - 5)

1. ( ) BL

m

mm Nθπθθθ −≥+−=∆ 2

we must also have 0≥mθ

2. ( ) BL

m

mm Nθπθθθ +−≤+−=∆ 2

we must also have 0≤mθ

When one of those events occurs Contact Flag changes from .True. to .False.

4. changes signSTICKrmT

0=BLεInitialize

3. ( )+−=∆ mm θθθ

changes sign

it is enough to compute ( )+−=∆ mm θθθ Since during contact we have LLm N θθ =

and to check if change sign.mrmSTICKT θ, Here is the motor gear position when Start Contact.( )+mθ

39

SOLO Backlash

Dynamic Computations if No Contact

Compute

Contact Flag = .False.

0== mrrm rFT

m

DmrmCTBm J

TTiK −−=−ωθ

L

LDLrmLBL J

TTTN +−=+ωθ

Integrate both equations to obtain

BLBm ωθωθ +− , Compute and integrate to obtainLm θθ , Lm θθ ,

Backlash Logic (continue - 6)

Compute LLmBL N θθε −=:

Integrate to obtainBLε BLε

If Start Contact Flag changes from .False. to .True. for one computation cycle and in the next one back to .False.

BLBL θε ≥

40

SOLO BacklashBacklash Logic (continue - 7)

Contact Between Gears Teeth is Detected

( )[ ] ( )mr

LmL

LDLmLBLmDmCTLrm rF

NJJ

TTJNNJTiKJT

STICK=

+++++−= 2

1 ω

Compute

( ) ( ) ( )( ) ( ) ( )[ ]−−−

+++−=+ mLL

mLL

Lmm N

JNJ

Je θθθθ 2

1

( ) ( ) ( )( ) ( ) ( )[ ]−−−

++−−=+ mLL

mLL

mLLL N

JNJ

JNe θθθθ 2

1

on pressure line 1 if 210 GG →>θ

120 GG →<θ If 0>= mrrm rFT

STICK

Contact begins at point A

Contact begins at point B

on pressure line 2 if 120 GG →>θ

210 GG →<θ If 0<= mrrm rFT

STICK

Contact begins at point C

Contact begins at point D

Contact Start changes from .False. to .True.

Store ( ) mθθ =+

Reinitialize the integrators using

41

SOLO BacklashBacklash Logic (continue - 8)

When Contact Start = .True. the elastic collisions between gears teeth will occur and the time between two successive collisions will be

( )e

a

TT nBL

ε2

1 −= −

LLmBL N θθε −=θa

BLθ

( )−0BLε

The two gearsstick together

LLmBL N θθε −=

( )−− 0BLe ε

LLmBL N θθε −=

1−nTnT

( )e

a

TT NBL

ε2

1 −= −

We can see that if e=0 (plastic collision), we have T1 = 0 and the teeth remain in contact. In this case

Contact Flag = .True.

when Contact Start = .True.

0=e If

( ) ( ) ( )( ) ( ) ( )[ ]

0

2

1

=

−−−+++−=+

e

mLL

mLL

Lmm N

JNJ

Je θθθθ

( ) ( ) ( )( ) ( ) ( )[ ]

0

2

1

=

−−−+

+−−=+e

mLL

mLL

mLLL N

JNJ

JNe θθθθ

STICKrm

mLL

Lm TJNJ

JJa 2+

Contact Between Gears Teeth is Detected (continue - 1)

Reinitialize the integrators using

42

SOLO Backlash

To prevent numerical problems, when

Contact Flag = .True.

Backlash Logic (continue - 9)

When Contact Start = .True. the elastic collisions between gears teeth will occur and the time between two successive collisions will be

( )e

a

TT nBL

ε2

1 −= −

LLmBL N θθε −=θa

BLθ

( )−0BLε

The two gearsstick together

LLmBL N θθε −=

( )−− 0BLe ε

LLmBL N θθε −=

1−nTnT

( )e

a

TT NBL

ε2

1 −= −

tTn ∆≤ (where Δt is related to the integration time), we say that the two gears teeth are in continuous contact and we declare

To assure that the teeth gears are in continuous contact, we will reinitialize using e=0, for this computation cycle.

( ) ( )++ 0,0 Lm θθ

( ) ( ) ( )( ) ( ) ( )[ ]

0

2

1

=

−−−+++−=+

e

mLL

mLL

Lmm N

JNJ

Je θθθθ

( ) ( ) ( )( ) ( ) ( )[ ]

0

2

1

=

−−−+

+−−=+e

mLL

mLL

mLLL N

JNJ

JNe θθθθ

0≠e If

STICKrm

mLL

Lm TJNJ

JJa 2+

Return to the Table of Content

Contact Between Gears Teeth is Detected (continue - 2)

43

SOLO Backlash

Equations of Motion (Summary)

44

SOLO Backlash

Equations of Motion (Summary 1)

Return to the Table of Content

45

SOLO BacklashBacklash Logic (continue - 10)

When Contact Start = .True. instead of performing reinitialization of integrals we can, for one computation cycle, simulate the impulseat collision.

LLmBL N θθε −=θa

BLθ

( )−0BLε

The two gearsstick together

LLmBL N θθε −=

( )−− 0BLe ε

LLmBL N θθε −=

1−nTnT

( )e

a

TT NBL

ε2

1 −= −

by using

Contact between gears is detected (continue - 1)

( ) ( ) ( )[ ]−−−+

+=∆=∆ LLm

mLL

Lmmrrm N

JNJ

JJerPtT

Cθθ

2

1

( ) ( ) ( )[ ]−−−+

+∆

= LLm

mLL

Lmrm N

JNJ

JJe

tT

Cθθ

2

11

46

SOLO Backlash

Equations of Motion (Summary 2)

Return to the Table of Content

47

% Backlash%

% Solo Hermelin, March 2006%

% Simulates Backlash Effects of a Gear Transmission Driven by an Electric % Motor to Move a Predefined Load

clear

% Default Parameters dt=0.001;

DegtoRad = pi/180; %Transform fro Degrees to Radians %Motor Parameters

Jmotor = 1.14e-6; %Motor Inertia [Kg*m^2[ %Jmotor = 1.; %Motor Inertia [Kg*m^2[

Nmotor = 36; % Number of theeth on motor gear pmotor = 360/Nmotor; % Angle between two consecutive theeth on motor Gear (deg(

pmotorR = pmotor*DegtoRad; % Angle between two consecutive theeth on motor Gear (deg( Backlash = .25; % Percent of Motor Gear Angle for which theeth lose contact

%Load Parameters Jload = 8.5e-5; % Load Inertia [Kg*m^2[

%Jload = 1; % Load Inertia [Kg*m^2[ Nload = 72; % Number of theeth on load gear

NL = Nload/Nmotor; % Theeth Ratio NLJm = NL*Jmotor; NL2Jm = NL*NLJm;

JlNLJ2m=Jload+NL2Jm; TfM = 0.; % Friction Moment on Motor

TfL = 0.; % Friction Moment on Load

BacklashMATLAB Program (page 1)

48

% Initialization of State-Variables ThetM = 0.;

ThetM1Dot = 0.; PhiM2Dot = 0.;

ThetL = 0.; ThetL1Dot = 0.;

PhiL2Dot = 0.; epsBL = ThetM - NL*ThetL;

StartContact = 0; % Has value 1 only for one integration cycle, when gear theeth make contact Contact = 0.; % Change to 1 when gear theeth are in contact

k=0;

dt=input('Enter Integration Time Step (s(: '(; tend=input('Enter Final Simultion Time (s(: '(;

Backlash=input('Enter Backlash (0-1(: '(; el = input('Elasticity of Gear Theeth (0-1(: '(;

InMoment = input('Amplitude of Input Sinusoidal Moment (N*m(: '(; freqin = input('Frequency of Sinusoidal Input (Hz(: '(;

Aomegab = input('Amplitude of Sinusoidal Body Rate (rad/sec(:'(; fomegab = input('Frequency of Sinusoidal Body Rate (rad/sec(:'(;

omgi = 2*pi*freqin; omgob =2*pi*fomegab;

labelBacklash=['Backlash =' num2str(Backlash( [; labelel=['el =' num2str(el( [;

ThetBL = Backlash*pmotor; % Backlash angle at motor gear [deg[ ThetBLR = ThetBL*DegtoRad;

t=0;

BacklashMATLAB Program (page 2)

49

% Loop on time while t<=tend k = k+1;%plot index % Inputs KtIc = InMoment*cos(omgi*t(; %Sinusoidal Input [N*m[ %KtIc = InMoment; Tload = 0.; % Load Moment [N*m[ OmegaB = Aomegab*sin(omgob*t(; % Body rate [rad/s[ OmegaDotB = Aomegab*omgob*cos(omgob*t(; % Body angular acceleration [rad/s^2[

epsDotBL = ThetM1Dot -NL*ThetL1Dot; %Computation of Stiction Moment TrmStick = ( Jload*(KtIc-TfM+Jmotor*(1+NL(*OmegaDotB(+NLJm*(Tload+TfL( (/JlNLJ2m;

BacklashMATLAB Program (page 3)

50

%Backlash Logic if (Contact==0( & (abs(epsBL(>= ThetBLR( StartContact = 1; % Integration cycle where theeth contact occurs TMP =0.5* Jmotor*Jload*abs(epsDotBL(/(abs(TrmStick(*JlNLJ2m(; if TMP<=dt Contact = 1; EndCntct1 = 0; EndCntct2 = 0; EndCntct3 = 0; ThetM1Dot =ThetM1Dot -Jload*epsDotBL/JlNLJ2m; %Rate change due to Plastic Impact ThetL1Dot =ThetL1Dot +NLJm*epsDotBL/JlNLJ2m; %Rate change due to Plastic Impact Thetcntct = ThetM; sgnTstck = sign (TrmStick(; epsBL = 0.; p = 0; % index else ThetM1Dot =ThetM1Dot -(1+el(*Jload*epsDotBL/JlNLJ2m; %Rate change due to Elastic Impact ThetL1Dot =ThetL1Dot +(1+el(*NLJm*epsDotBL/JlNLJ2m; %Rate change due to Elastic Impact Contact = 0; end %TMP<=dt end %(Contact==0( & (abs(epsBL(>= ThetBLR(

BacklashMATLAB Program (page 4)

51

if (Contact==1( & (StartContact==0( %Check end of Contact

p = p + 1; DelThetM = ThetM - Thetcntct;

if p==1 sgnDelThM = sign (DelThetM(;

end if p>1

if (sign (DelThetM(~=sgnDelThM ( Contact = 0;

EndCntct1 = 1 elseif abs(DelThetM(>=(pmotorR-ThetBLR(

Contact = 0; EndCntct2 = 1

end end % p>1

if sign(TrmStick(~=sgnTstck Contact = 0;

EndCntct3 = 1 end

end % (Contact==1( & (StartContact==0(

if (Contact==1( Trm = TrmStick; else % Contact=0

Trm = 0; end % Contact==1

%End Backlash Logic

BacklashMATLAB Program (page 5)

52

% Motor DynamicsThetM2Dot = (KtIc-TfM-Trm(/Jmotor+OmegaDotB ;

%Load DynamicsThetL2Dot = (NL*Trm-Tload-TfL(/Jload-OmegaDotB ;

%Plot Data PreparationT (k( = [t[;ktic (k( = [KtIc[;thetm (k( = [ThetM/DegtoRad[;thethm1d (k( = [ThetM1Dot[;thetm2d (k( = [ThetM2Dot[;thetl (k( = [NL*ThetL/DegtoRad[;thethl1d (k( = [NL*ThetL1Dot[;thetl2d (k( = [NL*ThetL2Dot[;epsBLD (k(= [epsBL/DegtoRad[;epsD (k( = [(ThetM-NL*ThetL(/DegtoRad[;epsdotBL (k( = [epsDotBL[;strtcontct (k( = [StartContact[;contct (k( = [Contact[;

BacklashMATLAB Program (page 6)

53

%Integration of State Variables if StartContact == 1

StartContact =0; else

ThetM1Dot = ThetM1Dot+ThetM2Dot*dt; ThetL1Dot = ThetL1Dot+ThetL2Dot*dt;

end if Contact==0

epsBL =epsBL + epsDotBL*dt; end

ThetM = ThetM + ThetM1Dot*dt; ThetL = ThetL + ThetL1Dot*dt;

t=t+dt;end % of Time Loop t<=tend

figure(1(plot(T,thetm2d ,'g-'(;

legend(labelBacklash,labelel(;hold on;

plot(T,thetl2d ,'r-.'(;hold off;title('Angular Acceleration of Motor and Load Versus Time'(,

%axis([0 5 -1 1[(,grid, xlabel('Time (s('(, ylabel('ThetM2dot, NL*ThetL2dot (rad/s^2('(,

BacklashMATLAB Program (page 7)

54

figure(2(plot(T,thethm1d,'b-'(;

legend(labelBacklash,labelel(;hold on;

plot(T,thethl1d,'r-.'(;hold off;

title('Angular Rates of Motor and Load Versus Time '(,%axis([0 1 -0.1 0.1[(,

grid, xlabel('Time (s('(, ylabel('ThetM1dot, NL*ThetL1dot (rad/s('(,

figure(3(plot(T,thetm ,'b-'(;

legend(labelBacklash,labelel(;hold on;

plot(T,thetl,'r-.'(;hold off;title('Angles of Motor and Load Versus Time'(,

%axis([0 5 -180 180[(,grid, xlabel('Time (s('(, ylabel('Theta_Motor, NL*Theta_Load (deg('(,

figure(4(plot(T,epsBLD ,'b-'(;

legend(labelBacklash,labelel(;hold off;title('Angle Errors EpsBL (deg( of Motor and Load Versus Time'(,

%axis([0 5 -180 180[(,grid, xlabel('Time (s('(, ylabel('EpsBL (deg('(,

BacklashMATLAB Program (page 8)

55

figure(5(plot(T,epsBLD ,'b-'(;

legend(labelBacklash,labelel(;hold on;

plot(T,epsD,'r-.'(;hold off;title('Angle Errors EpsBL & Eps (deg( of Motor and Load Versus Time'(,

%axis([0 5 -180 180[(,grid, xlabel('Time (s('(, ylabel('EpsBL, Eps (deg('(,

figure(6(plot(T,epsdotBL,'b--'(;

legend(labelBacklash,labelel(;hold off;title('Rate of Angles of Errors (rad/s( Versus Time'(,

%axis([0 1 -0.1 0.1[(,grid, xlabel('Time (s('(, ylabel('EpsDotBL (rad/s('(,

pause

BacklashMATLAB Program (page 9)

Return to the Table of Content

56

0 0.01 0.02 0.03 0.04 0.05 0.06 0.07 0.08 0.09 0.1-0.06

-0.04

-0.02

0

0.02

0.04

0.06Rate of Angles of Errors (rad/s) Versus Time

Time

Eps

Dot

BL

Backlash =0.01el =0.9

0 0.01 0.02 0.03 0.04 0.05 0.06 0.07 0.08 0.09 0.1-0.03

-0.02

-0.01

0

0.01

0.02

0.03

0.04

0.05

0.06Rate of Angles of Errors (rad/s) Versus Time

Time

Eps

Dot

BL

Backlash =0.01el =0.5

0 0.01 0.02 0.03 0.04 0.05 0.06 0.07 0.08 0.09 0.10

0.01

0.02

0.03

0.04

0.05

0.06Rate of Angles of Errors (rad/s) Versus Time

Time

Eps

Dot

BL

Backlash =0.01el =0

Simulation Results

570 0.1 0.2 0.3 0.4 0.5 0.6 0.7 0.8 0.9 1

-0.06

-0.04

-0.02

0

0.02

0.04

0.06Rate of Angles of Errors (rad/s) Versus Time

Time

Eps

Dot

BL

Backlash =0.01el =0.9

0 0.1 0.2 0.3 0.4 0.5 0.6 0.7 0.8 0.9 1-0.1

-0.08

-0.06

-0.04

-0.02

0

0.02

0.04

0.06

0.08

0.1Angular Rates of Motor and Load Versus Time

Time

The

tM1d

ot,

The

tL1d

otBacklash =0.01el =0.9

0 0.1 0.2 0.3 0.4 0.5 0.6 0.7 0.8 0.9 1-0.06

-0.04

-0.02

0

0.02

0.04

0.06Rate of Angles of Errors (rad/s) Versus Time

Time

Eps

Dot

BL

Backlash =0.01el =0

0 0.1 0.2 0.3 0.4 0.5 0.6 0.7 0.8 0.9 1-0.1

-0.08

-0.06

-0.04

-0.02

0

0.02

0.04

0.06

0.08

0.1Angular Rates of Motor and Load Versus Time

Time

The

tM1d

ot,

The

tL1d

ot

Backlash =0.01el =0

Return to the Table of Content

58

SOLO Backlash

References

1. Donald T. Greenwood, “Principles of Dynamics”, Prentice Hall, 1965

2. Wolfram Stadler, “Analytical Robotics and Mechatronics”, McGraw-Hill, 1995

3. Hamilton H. Mabie and Fred W. Ocvirk, “Mechanism and Dynamics of Machinery”, SI Version, Third Edition, John Wiley & Sons, 1978

4. Joseph E. Shigley, Charles R. Mischke, Richard G. Budynas, “Mechanical Engineering Design”, Seventh Edition, McGraw-Hill, 2004

Return to the Table of Content

5. Solo Hermelin, “Gears” Presentation, http://www.solohermelin.com

January 4, 2015 59

SOLO

TechnionIsraeli Institute of Technology

1964 – 1968 BSc EE1968 – 1971 MSc EE

Israeli Air Force1970 – 1974

RAFAELIsraeli Armament Development Authority

1974 – 2013

Stanford University1983 – 1986 PhD AA

top related