Feedback Linearization Based Guidance

21
Feedback Linearization Feedback Linearization Based Guidance Based Guidance G. Weiss Technion, Faculty of Electrical Engineering 1 Project under the supervision of Dr. I. Rusnak Control and Robotics Lab June, 2010 June 10, 2022

description

Feedback Linearization Based Guidance. G. Weiss. Project under the supervision of Dr. I. Rusnak. Control and Robotics Lab June, 2010. Outline. Objectives Project milestones Planar scenario description Guidance problem formulation Feedback linearization Guidance strategies - PowerPoint PPT Presentation

Transcript of Feedback Linearization Based Guidance

Page 1: Feedback Linearization Based Guidance

Feedback LinearizationFeedback LinearizationBased GuidanceBased Guidance

G. Weiss

Technion, Faculty of Electrical Engineering1

Project under the supervision ofDr. I. Rusnak

Control and Robotics LabJune, 2010

April 21, 2023

Page 2: Feedback Linearization Based Guidance

OutlineOutline

• Objectives

• Project milestones

• Planar scenario description

• Guidance problem formulation

• Feedback linearization

• Guidance strategies

• Performance example

• Summary

Technion, Faculty of Electrical Engineering2 April 21, 2023

Page 3: Feedback Linearization Based Guidance

ObjectivesObjectives

To examine the guidance problem of an acceleration-constrained homing missile when the initial missile heading is far from collision course using feedback linearization

The presented work is based on the paper S. Bezick, I. Rusnak, and W. S. Gray, “Guidance of a Homing Missile Via Nonlinear Geometric Control Methods” ,AIAA Journal of Guidance, Control, and Dynamics, vol. 18, no. 3, May-June 1995, pp. 441-448.

Technion, Faculty of Electrical Engineering3 April 21, 2023

Page 4: Feedback Linearization Based Guidance

Technion, Faculty of Electrical Engineering4 April 21, 2023

Project MilestonesProject Milestones

• Phase 1Phase 1– Study of the Feedback Linearization method– Validation of 2D simulation results

presented in the paper– Performance analysis

• Phase 2Phase 2– Derivation of 3D scenario guidance laws– Simulations– Performance analysis

Page 5: Feedback Linearization Based Guidance

Planar scenario descriptionPlanar scenario description

Technion, Faculty of Electrical Engineering5

RTM

VT

aT

VM

aMΨM

ΨT

σReference direction

April 21, 2023

(xT , yT)

(xM , yM)

Target

Missile

Page 6: Feedback Linearization Based Guidance

Guidance problem Guidance problem formulationformulation

April 21, 2023Technion, Faculty of Electrical Engineering6

M M M

M M M

MM M MAX

M

T T T

T T T

TT

T

x V cos

y V sin

aa A

V

x V cos

y V sin

aV

M

TM

x f ( x ) g( x )a

y h( x ) R ( x )

Assumptions

• Ideal aerodynamics

• Constant velocities

• Ideal autopilot

• Full information

knowledge

1M

c

a sa s

,M TV V

Page 7: Feedback Linearization Based Guidance

Feedback LinearizationFeedback Linearization

Consider the single input single output system

find a state feedback control such that the input-output system from to is a linear mapping.

Using Lie Derivatives, such a satisfies

April 21, 2023Technion, Faculty of Electrical Engineering7

x f ( x ) g( x )uy h( x )

u x vx v y

u

11 r

frg f

u L h xL L h x

v

Page 8: Feedback Linearization Based Guidance

Guidance strategiesGuidance strategies

Large heading errorLarge heading error

closing velocity resulting from

Small heading errorSmall heading error

April 21, 2023Technion, Faculty of Electrical Engineering8

21M TM T T

M

c cd

cd

v

v

a R a sinsin

K V V

V

0LOSRV

M ca N V

FLGL

PN

Page 9: Feedback Linearization Based Guidance

Performance examplePerformance example

April 21, 2023Technion, Faculty of Electrical Engineering9

RTM

VT

VM

σ

ΨM

2

2

1000

1000

250

270

0

160

0

1000

TM

M

T

M

T

T

max

R m

V m / sec

V m / sec

a m / sec

A m / sec

Scenario ParametersTarget

Missile

Page 10: Feedback Linearization Based Guidance

Performance examplePerformance example

Technion, Faculty of Electrical Engineering10

-1000 -500 0 500 1000 1500 2000 2500-2500

-2000

-1500

-1000

-500

0

500

x axis [m]

y ax

is [

m]

Missile and Target Trajectories

PN

FLGLRGL

Target

April 21, 2023

0

0max

Mmax

M

c

c

c

A sign Va

A V

a N V

Ref Guidance Law

Large heading error

Small heading error

Page 11: Feedback Linearization Based Guidance

Performance examplePerformance example

Technion, Faculty of Electrical Engineering11

0 1 2 3 4 5 6 7

-1000

-800

-600

-400

-200

0

200

400

600

800

1000

Time [sec]

a m [m

/sec

2 ]

Missile acceleration vs. time

PN

FLGLRGL

tfinal = 6.5631 [sec]

tfinal = 6.5415 [sec]

April 21, 2023

Page 12: Feedback Linearization Based Guidance

Performance examplePerformance example

Technion, Faculty of Electrical Engineering12 April 21, 2023

0 1 2 3 4 5 6 7-70

-60

-50

-40

-30

-20

-10

0

10

Time [sec]

Sig

ma

dot

[deg

/sec

]LOS rate vs. Time

PN

FLGL

RGL

Page 13: Feedback Linearization Based Guidance

SummarySummary

• Feedback Linearization method has been studied and implemented

• Simulation results have been validated successfully

• 3D implementation of FLGL is on the way

Technion, Faculty of Electrical Engineering13 April 21, 2023

Page 14: Feedback Linearization Based Guidance

Thank you all for listeningThank you all for listening

Technion, Faculty of Electrical Engineering14 April 21, 2023

Page 15: Feedback Linearization Based Guidance

Backup SlidesBackup Slides

Outline Outline – Lie derivativesLie derivatives– End game geometryEnd game geometry– Guidance strategiesGuidance strategies– Feedback linearization guidance law Feedback linearization guidance law – Guidance loopGuidance loop– Minimum intercept time guidance Minimum intercept time guidance

lawlaw

Technion, Faculty of Electrical Engineering15 April 21, 2023

Page 16: Feedback Linearization Based Guidance

Lie derivativesLie derivatives

Technion, Faculty of Electrical Engineering16 April 21, 2023

Let be sufficiently smooth in , the Lie Derivative of with respect to is

denoted by f

dhL h x f x

dx

2

1

1

0

1

f

g f

f

f f f

kfk k

f f f

f

d L hL L h x g x

dx

d L hL h x L L h x f x

dx

d L hL h x L L h x f x , k

dx

L h x h x

Used notations:

f , h n h f

Page 17: Feedback Linearization Based Guidance

End game geometryEnd game geometry

April 21, 2023Technion, Faculty of Electrical Engineering17

Collision triangle

LOS LOSR T M R R

LOSR C TM

LOSR TM

V V V V V

V V R

V R

VT

VM

predicted intercept point

LOS

Page 18: Feedback Linearization Based Guidance

Guidance strategiesGuidance strategies

April 21, 2023Technion, Faculty of Electrical Engineering18

VT

LOS

predicted intercept point

VM leading the target

VM lagging the target

Case 2: VM lagging the Target

2

sin sin 0T

C CDV V

Case 1: VM leading the Target

1

sin sin 0T

C CDV V

Page 19: Feedback Linearization Based Guidance

FFeedbackeedback LLinearizationinearization GGuidanceuidance LLawaw

April 21, 2023Technion, Faculty of Electrical Engineering19

2

1 1

2 2

1

221

2

1

0

0

TM T T MMM

M

C CD T

C CD T

M M M ,pip

T TM ,pip

M

CD M T T T T

CD

C

v R a sin ,sina

N V ,

K V V , sin sinv

K V V , sin sin

V sinsin

V

V V V sin V cos

V V

M T TV cos

VCD1 = closing velocity resulted from 0LOS

RV

VCD2 = leads to the rotation of MV

Page 20: Feedback Linearization Based Guidance

Guidance loop descriptionGuidance loop description

April 21, 2023Technion, Faculty of Electrical Engineering20

Guidance Loop Block Diagram

- Known target dynamics

- Ideal missile autopilot

Page 21: Feedback Linearization Based Guidance

Minimum intercept time guidance Minimum intercept time guidance lawlaw

0

0m m ma V

April 21, 202321 Technion, Faculty of Electrical Engineering

0

0

th

maxM

max

th

M

c

c

c

if

A sign Va

A V

if

a N V