16
Πανεπιςτήμιο Πατρών Τμήμα Ηλεκτρολόγων Μηχανικών και Τεχνολογίασ Υπολογιςτών Τομέασ Συςτημάτων Αυτομάτου Ελέγχου Μάθημα Προςαρμοςτικόσ Έλεγχοσ 1 | Σελίδα Project ζην κάζεκα Προζαρμοζηικός Έλεγτοςκε ζέκα ’Ελεγτος ζσζηήμαηος ζθαίρας-ράβδοσ με τρήζη Προζαρμοζηικού ΕλέγτοσΣπκκετέρνλτεο: Μπάξηδεο Χξήζηνο, 7321 Παπαδόπνπινο Γεώξγηνο – Μάξηνο, 7356 Έτνο: 2013 Εμάκελν: 9 o Πεξηερόκελα

Adaptive Control of Ball-Beam System

Embed Size (px)

DESCRIPTION

Adaptive's Control Project Report - University of Patras - Electrical and Computer Engineering

Citation preview

Page 1: Adaptive Control of Ball-Beam System

Πανεπιςτήμιο Πατρών Τμήμα Ηλεκτρολόγων Μηχανικών και Τεχνολογίασ Υπολογιςτών

Τομέασ Συςτημάτων Αυτομάτου Ελέγχου Μάθημα Προςαρμοςτικόσ Έλεγχοσ

1 | Σ ε λ ί δ α

Project ζην κάζεκα

“Προζαρμοζηικός Έλεγτος”

κε ζέκα

“’Ελεγτος ζσζηήμαηος ζθαίρας-ράβδοσ με

τρήζη Προζαρμοζηικού Ελέγτοσ”

Σπκκετέρνλτεο:

Μπάξηδεο Χξήζηνο, 7321

Παπαδόπνπινο Γεώξγηνο – Μάξηνο, 7356

Έτνο: 2013

Εμάκελν: 9o

Πεξηερόκελα

Page 2: Adaptive Control of Ball-Beam System

Πανεπιςτήμιο Πατρών Τμήμα Ηλεκτρολόγων Μηχανικών και Τεχνολογίασ Υπολογιςτών

Τομέασ Συςτημάτων Αυτομάτου Ελέγχου Μάθημα Προςαρμοςτικόσ Έλεγχοσ

2 | Σ ε λ ί δ α

Σθνπόο

H παξνύζα εξγαζία πξαγκαηεύεηαη ηνλ πξνζαξκνδόκελν έιεγρν

ηνπ ζπζηήκαηνο ξάβδνο-ζθαίξα ζηα πιαίζηα ηνπ καζήκαηνο

“Προζαρμοζηικός Έλεγτος” θαηά ην 9ν εμάκελν.

Page 3: Adaptive Control of Ball-Beam System

Πανεπιςτήμιο Πατρών Τμήμα Ηλεκτρολόγων Μηχανικών και Τεχνολογίασ Υπολογιςτών

Τομέασ Συςτημάτων Αυτομάτου Ελέγχου Μάθημα Προςαρμοςτικόσ Έλεγχοσ

3 | Σ ε λ ί δ α

Πεξηγξαυή Σπστήκατνο

Τν ζύζηεκα ζθαίξαο-ξάβδνπ είλαη κηα πνιύ γλσζηή πεηξακαηηθή

δηάηαμε, ε νπνία ζπλαληάηαη ζε πνιιά εξγαζηήξηα απηνκάηνπ ειέγνπ.

Η ξάβδνο πεξηζηξέθεηαη ζε έλα θάζεην επίπεδν κέζσ κηαο ξνπήο ε

νπνία δύλαηαη ζην θέληξν πεξηζηξνθήο από έλαλ (ζπλήζσο) DC

ζεξβνθηλεηήξα. Η ζθαίξα θπιάεη ειεύζεξα πάλσ ζηε ξάβδν θαη ζε

επαθή κε απηήλ.

Oη εμηζώζεηο θίλεζεο ηνπ ζπζηήκαηνο είλαη:

1 2x x

2 (x)x B

3 4x x

4x U , where 21 1(x) (Mx J J )Ubu M (1)

2/ R/ (J )b MM , 2

1 4 3(x) sin( )B x x G x and 1 1 2 4 1 3(x) cos( )2 x x Gx xx

Όπνπ x1 : ζέζε ζθαίξαο

x2 : ηαρύηεηα ζθαίξαο

x3 : γσλία ξάβδνπ

x4 : γσληαθή ηαρύηεηα ξάβδνπ

u : ξνπή εηζόδνπ

J : ξνπή αδξάλεηαο ξάβδνπ

Jb : ξνπή αδξάλεηαο ζθαίξαο

Μ : κάδα ηεο ζθαίξαο

R : αθηίλα ηεο ζθαίξαο

G : επηηάρπλζε ηεο βαξύηεηαο

Page 4: Adaptive Control of Ball-Beam System

Πανεπιςτήμιο Πατρών Τμήμα Ηλεκτρολόγων Μηχανικών και Τεχνολογίασ Υπολογιςτών

Τομέασ Συςτημάτων Αυτομάτου Ελέγχου Μάθημα Προςαρμοςτικόσ Έλεγχοσ

4 | Σ ε λ ί δ α

To ζύζηεκα είλαη έλα ππνελεξγνπνηεκέλν ζύζηεκα κηαο θαη ν

αξηζκόο ησλ ελεξγνπνηεηώλ είλαη κηθξόηεξνο από ησλ αξηζκώλ ησλ

βαζκώλ ειεπζεξίαο (DOF’s). Ο λόκνο ειέγρνπ ησλ ζπζηεκάησλ απηώλ

κπνξεί λα ζρεδηαζζεί ρξεζηκνπνηώληαο ηερληθέο κε γξακκηθνύ ειέγρνπ.

Γηα ην κε-γξακκηθό ζύζηεκα ζθαίξαο-ξάβδνπ ε θπζηθε επηινγή

εθηέιεζεο ηνπ λόκνπ ειέγρνπ κπνξεί λα είλαη ε κέζνδνο ηεο

γξακκηθνπνηεκέλεο αλάδξαζεο (feedback linearization). Γπζηπρώο,

όκσο, ν ζρεηηθόο βαζκόο ηνπ ζπζηήκαηνο (relative degree) δελ είλαη

ζσζηά θαζνξηζκέλνο εμαηηίαο ηνπ θπγόθεληξνπ όξνπ 2

1 4x x πνπ βξίζθεηαη

ζηελ έθθξαζε B . Γηα ην ιόγν απηόη ε ζπκβαηηθή πξνζέγγηζε

γξακκηθνπνίεζεο εηζόδνπ-εμόδνπ (input-output) δελ είλαη εθαξκόζηκε

ζην ζύζηεκα απηό. Η θιαζζηθή Ιαθσβηαλή (Jacobian) κέζνδνο

γξακκηθνπνίεζεο κπνξεί λα ππνινγίζεη θαιά ην κε-γξακκηθό κνληέιν

κόλν όηαλ νη θαηαζηάζεηο είλαη πνιύ θνληά ζην ζεκείν

γξακκηθνπνίεζεο.

Μνλτέιν γηα Πξνσαξκνδόκελν Νόκν Ειέγρνπ

Πξνθεηκέλνπ λα ιύζνπκε ηνλ πξνζαξκνδόκελν έιεγρν ηνπ

ζπζηήκαηνο ζθαίξαο-ξάβδνπ αο μαλαγξάςνπκε ηηο εμηζώζεηο θίλεζεο

ζηελ αθόινπζε κνξθή

1 2x x

2 (x)x B

3 4x x

4 1 1 2(x) KK u dx (2)

Όπνπ 1 2

1( )

M

Mx J JbK

, 2 2

1

1

( )Mx J JbK

θαη d δειώλεη ηηο εμσηεξηθέο

δηαηαξαρέο θαη ηα πξόζζεηα ζθάικαηα ηνπ κνληέινπ ηα νπνία

ζεσξνύληαη θξαγκέλα δειαδή md D .

Να ζεκεησζεί, επίζεο, όηη ε ηηκή Κ2 είλαη θξαγκέλε όπνπ

2 21/ K m όπνπ Κ2m ηζνύηαη J + Jb. Η νξηνζέηεζε ηνπ Κ2 είλαη εγγπεκέλε

Page 5: Adaptive Control of Ball-Beam System

Πανεπιςτήμιο Πατρών Τμήμα Ηλεκτρολόγων Μηχανικών και Τεχνολογίασ Υπολογιςτών

Τομέασ Συςτημάτων Αυτομάτου Ελέγχου Μάθημα Προςαρμοςτικόσ Έλεγχοσ

5 | Σ ε λ ί δ α

από ην πεπεξαζκέλν κήθνο ηεο ξάβδνπ. Οη παξάκεηξνη Κ1 θαη Κ2 είλαη

ρξνληθά κεηαβαιιόκελνη θαη εμαξηώληαη από ην x1. Όκσο, όηαλ ε κάδα

ηεο ζθαίξαο δελ είλαη κεγάιε θαη θηλείηαη θνληά ζην θέληξν ηεο ξάβδνπ

νη παξάκεηξνη απηνί κπνξνύλ λα ζεσξεζνύλ αξγώο κεηαβαιιόκελνη θαη

online αιγόξηζκνη εθηίκεζεο κπνξνύλ λα εθαξκνζζνύλ ζην λα

θαζνξηζζνύλ νη ηηκέο ηνπο. Σε άιιε πεξίπησζε κπνξνύλε λα

πξνζεγγηζηνύλ κε απιά Γνκηθά Νεπξσληθά Γίθηπα (SNN) κηαο εηζόδνπ

(input-x1) θαη κηαο εμόδνπ (output-K2) όπσο ην RBF Νεπξσληθό Γίθηπν

(Neural Network). Σηελ πεξίπησζε απηή, ην Κ2 κπνξεί λα γξαθεί σο

2 22 1 1( ) (x )x

όπνπ

2 αληηπξνζσπεύεη ην άγλσζην δηάλπζκα βάξνπο

θαη ην 2

είλαη ην δηάλπζκα ησλ γλσζηώλ ζπλαξηήζεσλ βάζεο.

Δπηπιεόλ, ην Κ1 κπνξεί λα πξνζεγγηζηεί κε ηνλ ίδην ηξόπν θαη ε

ηειεπηαία εμίζσζε (2) κπνξεί λα γξαθεί σο 1 21 2

4 1 1(x ) (x )u dx

.

Οη άγλσζηεο παξάκεηξνη βάξνπο 1

, 2

ηνπ λεπξσληθνύ δηθηύνπ

κπνξνύλ λα ζπληνληζηνύλ online.

Μνλτέιν βασησκέλν στνλ έιεγρν παξαθνινύζεσεο( Tracking

control)

Πξνθεηκέλνπ λα αλαπηύμνπκε έλαλ λόκν ειέγρνπ γηα ην ζύζηεκα

ζθαίξα-ξάβδνο, αο νξίζνπκε ηηο παξαθάησ κεηξηθέο ζρέζεηο ζθάικαηνο

(metric errors):

1 2 2 2 1 1 4 3((x ) (x )) ( )d dS a x x x xS aS (3)

Όπνπ α,ι>1 θαη x1d αλαπαξηζηά κηα θξαγκέλε, δηπιά δηαθνξίζηκε

ηξνρηά ηεο κπάιαο, 2 1d dxx . O πξώηνο όξνο (S1) ησλ κεηξηθώλ ζρέζεσλ

ιάζνπο αλαπαξηζηά ην ζθάικα παξαθνινύζεζεο ηεο ζθαίξαο. Ο

δεύηεξνο όξνο( S2) νξίδεηαη γηα λα απνθύγνπκε κεγάιε πιάηεο ηεο

θίλεζε ηεο ζθαίξαο, ηα νπνία ζα εηζάγνπλ ζε θιεηζηό βξόγρν ην

ζύζηεκα κε πεξηνξηζκέλν θύθιν ή αθόκα θαη ζε αζηάζεηα. Η

πξνεγεζείζα πεξηγξαθόκελε ηξνρηά ηεο ζθαίξαο( x1d) ζα έπξεπε επίζεο

λα πεξηγξαθεί κε ηέηνην ηξόπν ώζηε ε ηξνρηά λα έρεη ρακειέο κέγηζηεο

ηηκέο γηα ηελ επηζπκεηή ηαρύηεηα ( 1dx ) θαη επηηάρπλζε ( 1dx ).

Page 6: Adaptive Control of Ball-Beam System

Πανεπιςτήμιο Πατρών Τμήμα Ηλεκτρολόγων Μηχανικών και Τεχνολογίασ Υπολογιςτών

Τομέασ Συςτημάτων Αυτομάτου Ελέγχου Μάθημα Προςαρμοςτικόσ Έλεγχοσ

6 | Σ ε λ ί δ α

Από ζεσξεηηθή ζθνπηά νη κεηξηθέο ζρέζεηο ζθάικαηνο (3)

κπνξνύλ λα ελεξγήζνπλ σο αθνινύζσο: νξίδνπκε Δ ζαλ 1 1 3x )( dx xa .

Έηζη ην S κπνξεί λα γξαθεί σο S E E . Αλ έλαο (νιηζζαίλσλ ηύπνο)

έιεγρνο κπνξεί λα βξεζεί, ην νπνίν ζεκαίλεη όηη S SS k κε ks >0, ηόηε

0S θαζώο t .Απηό παξάγεη 1 1 3x ) 0( dx xa θαζώο t .

Από πξαθηηθή ζθνπηά δε πξνζκέλνπκε ην ζθάικα θαζώο t ην

0S , επεηδή ε θίλεζε ηεο ζθαίξαο ζεσξεί όηη ν δεύηεξνο όξνο (S2) ηνπ

S πξαθηηθά δελ ζα είλαη πνηέ 0. Έηζη, νξίδνπκε ην επηηεύμηκν ζθάικα

λα νξηνζεηεί Φ>0 θαη λα αλαδηαηππώλεη ηηο κεηξηθέο ζρέζεηο ζθάικαηνο

σο ( / )S sat SS . Αλ ν λόκνο ειέγρνπ εγγπάηαη όηη ε ζύγθιηζε ηνπ SΓ

ζην κεδέλ, ηόηε ην S ζα ζπγθιίλεη κέζα ζε έλα νξηνζεηεκέλν πεδίν κε

όξην Φ. Βαζηδόκελνη ζηελ δπλακηθή ηνπ ζπζηήκαηνο (2), ε δπλακηθή

ηνπ SΓ γηα S δίλεηαη από:

2 1 1 1 4 3((x ) (x )) ( )d da x x x xS S

1 2 2 1 1 2 4(( (x) ) ( )) ( )d dx x x K x K u x d (4)

Γηα λα βξνύκε έλα κνληέιν βαζηζκέλν ζηνλ λόκν ειέγρνπ γηα ην

ζύζηεκα ζθαίξα-ξάβδνο, νξίδνπκε ηελ αθόινπζε ζπλάξηεζε

Lyapunov:

21

2SV (5)

Αλ νη δηαηαξαρέο d είλαη ακειεηέεο ζηελ (4), ε ρξνληθή παξάγσγνο ηεο

ζπλάξηεζεο Lyapunov δίλεηαη από:

1 2 2 1 1 2 4( (( (x) ) ( )) ( ( ) ))d dV S S S x x x K x K u x (6)

Οξίδνπκε ηνλ λόκν ειέγρνπ σο:

1 2 2 1 1 4

2

1( (( (x) ) ( )) ( ( ) )d d su x x x K x x k S

K (7)

κε kS>0.

Page 7: Adaptive Control of Ball-Beam System

Πανεπιςτήμιο Πατρών Τμήμα Ηλεκτρολόγων Μηχανικών και Τεχνολογίασ Υπολογιςτών

Τομέασ Συςτημάτων Αυτομάτου Ελέγχου Μάθημα Προςαρμοςτικόσ Έλεγχοσ

7 | Σ ε λ ί δ α

Ο λόκνο ειέγρνπ u εγγπάηαη όηη 2 0S SV k , αλ SΓ 0, έηζη

εγγπάηαη ηελ νξηνζέηεζε ησλ κεηξηθώλ ζρέζεσλ ηνπ S. Δπηπξόζζεηα,

παξαηεξνύκε όηη ν λόκνο ειέγρνπ (7) παξάγεη ην ζθάικα

παξαθνινύζεζεο ηεο δπλακηθήο SS Sk .

Σύκθσλα κε ηνλ παξαπάλσ λόκν ειέγρνπ, ηαπηόρξνλα, ιύλεηαη ην

πξόβιεκα ζηαζεξνπνίεζεο θαη παξαθνινύζεζεο γηαην ππνδηεγεξκέλν

ζύζηεκα ζθαίξαο-ξάβδνπ.

Πξνέθτασε τνπ λόκνπ ειέγρνπ

Αλ ζεσξήζνπκε όηη νη παξάκεηξνη ηνπ ζπζηήκαηνο είλαη

άγλσζηνη, είλαη απαξαίηεηε ε πξνζαξκνδόκελε εθηίκεζε ησλ

παξακέηξσλ ηνπ ζπζηήκαηνο. Γεληθεύνληαο ην πξόβιεκα, ζεσξνύκε όηη

1 1(x)K θαη K2 γηα ηελ εμίζσζε (2) δηαηππώλνληαη σο: 1 1

1 1(x) (x)K

θαη

2 22 (x)K

κε άγλσζηεο παξακέηξνπο ηα δηαλύζκαηα

1 θαη

2 .

Αθνύ ε δπλακηθή ηνπ ζπζηήκαηνο ζθαίξα-ξάβδνο (1) δελ κπνξεί

λα γξαθεί ζε θαλνληθή κνξθή, νη κέζνδνη πξνζαξκνδόκελνπ ειέγρνπ

πνπ αλαπηύρζεθαλ γηα ζπζηήκαηα ζε θαλνληθή κνξθή δελ κπνξνύλ λα

εθαξκνζηνύλ απεπζείαο γηα ην ζύζηεκα ζθαίξα-ξάβδνο. Ο

πξνζαξκνδόκελνο έιεγρνο πνπ παξνπζηάζηεθε παξαπάλσ βαζίζηεθε

ζηηο κεηξηθέο εμηζώζεηο ζθάικαηνο (3).

Με ηηο άγλσζηεο παξακέηξνπο, ν λόκνο ειέγρνπ κπνξεί λα

δηαηππσζεί ρξεζηκνπνηώληαο ηηο εθηηκόκελεο παξακέηξνπο, νη νπνίεο

παξήρζεζαλ Online. Πξνθεηκέλνπ λα επηηύρνπκε ην ζηόρν ειέγρνπ

0S θαζώο t κε άγλσζηεο παξακέηξνπο, αο δηαηππώζνπκε ηνλ

λόκν ειέγρνπ:

2 2

2 2

2

( )u

( )

xu

x

κε

1 11 2 2 4(x) x ) ( )) ( / )(( ( )d d S mB x x k S D sat Su a x x

Page 8: Adaptive Control of Ball-Beam System

Πανεπιςτήμιο Πατρών Τμήμα Ηλεκτρολόγων Μηχανικών και Τεχνολογίασ Υπολογιςτών

Τομέασ Συςτημάτων Αυτομάτου Ελέγχου Μάθημα Προςαρμοςτικόσ Έλεγχοσ

8 | Σ ε λ ί δ α

Όπνπ δ>0 είλαη κηα κηθξή ζεηηθή ζηαζεξά θαη ξ ε αθόινπζε

ζπλάξηεζε:

1 1

0,

(g) / ,

1,otherwise

m

m m m

if g g

g g g if g g g g

Γηα ηηο άγλσζηεο παξακέηξνπο ε αθόινπζε εθηίκεζε κπνξεί λα

ρξεζηκνπνηεζεί:

(x)S

1 1 1

(x)S

2 2 2

2 22

(x)

(x) K m

S uS u

κε 0 , 1 2, 0

, απζηεξά ζεηηθά πεπεξαζκέλνη δηαγώληνη πίλαθεο.

Η ζύγθιηζε ηνπ SΓ θαη ε νξηνζέηεζε ησλ ζεκάησλ ζην ζύζηεκα

ειέγρνπ κπνξεί λα απνδεηρζεί κε ηνλ ίδην ηξόπν όπσο ην πξνεγνύκελν

θνκκάηη. Η ζπλάξηεζε Lyapunov νξίδεηαη σο:

1 1 2 21 2

22 1 11 1 1 1

( ) (t)2 2 2 2

V t S V

Πξνσνκνίωσε Σπστήκατνο

Οξίδνπκε ηηο παξακέηξνπο ηνπ ζπζηήκαηνο (απζαίξεηα), ζεσξώληαο όηη

ε ζθαίξα θπιίεηαη ρσξίο λα νιηζζαίλεη θαη όηη ε ηξηβή είλαη ακειεηέα.

Οη ζηαζεξέο θαη νη κεηαβιεηέο ηνπ ζπζηήκαηνο νξίδνληαη σο:

(m) mass of the ball 0.11 kg

(R) radius of the ball 0.015 m

(d) lever arm offset 0.03 m

(g) gravitational acceleration 9.8 m/s^2

(L) length of the beam 1.0 m

(J) ball's moment of inertia 9.99e-6 kg.m^2

(r) ball position coordinate

Page 9: Adaptive Control of Ball-Beam System

Πανεπιςτήμιο Πατρών Τμήμα Ηλεκτρολόγων Μηχανικών και Τεχνολογίασ Υπολογιςτών

Τομέασ Συςτημάτων Αυτομάτου Ελέγχου Μάθημα Προςαρμοςτικόσ Έλεγχοσ

9 | Σ ε λ ί δ α

(alpha) beam angle coordinate

(theta) servo gear angle

Η δεύηεξε παξάγσγνο ηεο γσλίαο εηζόδνπ a επεξεάδεηαη από ηε

δεύηεξε παξάγσγν ηεο αθηίλαο r. Όκσο, αγλνώληαο ην γεγνλόο απηό ε

ιαγθξαλδηαλή εμίζσζε θίλεζεο γηα ηε ζθαίξα νξίδεηαη σο εμήο:

2 2

2sin(a) mra0

Jm r mg

r

Η γξακκηθνπνίεζε ηεο εμίζσζεο απηήο γηα ηε γσλία ηεο ξάβδνπ

a=0 καο δίλεη ηελ αθόινπζε γξακκηθή πξνζέγγηζε ηνπ ζπζηήκαηνο:

2

2

Jm r mga

r

Η εμίζσζε πνπ ζπλδέεη ηελ γσλία ηεο ξάβδνπ κε ηε γσλία ηνπ

θηλεηήξα κπνξεί λα πξνζεγγηζηεί σο γξακκηθή από ηελ παξαθάησ

εμίζσζε:

da

L

Άξα ε πξνεγνύκελε εμίζσζε γίλεηαη:

2

2

J dm r mg

r L

Ο κεηαζρεκαηηζκόο Laplace ηεο ηειεπηαίαο εμίζσζεο είλαη:

2

2(s)s ( )

J dm R mg s

r L

Άξα ε ζπλάξηεζε κεηαθνξάο είλαη:

2

2

( )

( )

R s mgds

JsL m

r

Παραηήρηζη: Δπεηδή ν παξαλνκαοηήο έρεη έλαλ δηπιό νινθιεξσηή ηόηε

έρσ νξηαθή επζηάζεηα επνκέλσο ζα έρσ πξόβιεκα ζηνλ έιεγρν.

Page 10: Adaptive Control of Ball-Beam System

Πανεπιςτήμιο Πατρών Τμήμα Ηλεκτρολόγων Μηχανικών και Τεχνολογίασ Υπολογιςτών

Τομέασ Συςτημάτων Αυτομάτου Ελέγχου Μάθημα Προςαρμοςτικόσ Έλεγχοσ

10 | Σ ε λ ί δ α

Η ζπλάξηεζε κεηαθνξάο ζην MatLab πινπνηείηαη σο εμήο:

m = 0.111;

R = 0.015;

g = -9.8;

L = 1.0;

d = 0.03;

J = 9.99e-6;

s = tf('s');

P_ball = -m*g*d/L/(J/R^2+m)/s^2

Aλ ηξέμνπκε ηνλ θώδηθα, ε ζπλάξηεζε κεηαθνξάο πνπ πξνθύπηεη είλαη

ε παξαθάησ:

P_ball =

0.21

----

s^2

Continuous-time transfer function.

Tν γξακκηθνπνηεκέλν ζύζηεκα εμηζώζεσλ κπνξεί λα πεξηγξαθεί

θαη κέζσ ησλ θαηαζηαηηθώλ εμηζώζεσλ. Θεσξνύκε σο κεηαβιεηέο

θαηάζηαζεηο ηελ ζέζε θαη ηελ ηαρύηεηα ηεο κπάιαο θαη σο είζνδν ηελ

γσλία ηνπ θηλεηήξα.

2

0

0 1

0 0

r r mgd

r r JL m

R

Σην δηθό καο παξάδεηγκα ζα ρξεζηκνπνηήζνπκε ειαθξώο δηαθνξεηηθό

κνληέιν θαη αληί λα ειέγμνπκε ηε ζέζε κέζσ ηεο γσλίαο ηνπ θηλεηήξα

Page 11: Adaptive Control of Ball-Beam System

Πανεπιςτήμιο Πατρών Τμήμα Ηλεκτρολόγων Μηχανικών και Τεχνολογίασ Υπολογιςτών

Τομέασ Συςτημάτων Αυτομάτου Ελέγχου Μάθημα Προςαρμοςτικόσ Έλεγχοσ

11 | Σ ε λ ί δ α

ζα ειέγμνπκε ηε ξνπή ηεο ξάβδνπ. Οπόηε νη θαηαζηαηηθέο εμηζώζεηο

γίλνληαη:

2

0 1 0 0

00 0 0

0

0

0 0 0 0 1

0 0 0 0

r rmg

r rJm u

Ra a

a a

1 0 0 0

r

ry

a

a

Παραηήρηζη: Γηα ην ζύζηεκα απηό δελ ρξεζηκνπνηείηαη βξαρίνλαο αιιά

έλαο θηλεηήξαο ζην θέληξν ηεο ξάβδνπ πνπ ζα εθαξκόζεη ηελ ξνπή πνπ

απαηηείηαη γηα ηνλ έιεγρν ηεο ζέζεο ηεο κπάιαο.

Οη θαηαζηαηηθέο εμηζώζεηο ζην MatLab πινπνηνύληαη σο εμήο:

H = -m*g/(J/(R^2)+m);

A = [0 1 0 0

0 0 H 0

0 0 0 1

0 0 0 0];

B = [0 0 0 1]';

C = [1 0 0 0];

D = [0];

ball_ss = ss(A,B,C,D)

Aλ ηξέμνπκε ηνλ θώδηθα, πξνθύπηεη όηη:

ball_ss =

a =

x1 x2 x3 x4

Page 12: Adaptive Control of Ball-Beam System

Πανεπιςτήμιο Πατρών Τμήμα Ηλεκτρολόγων Μηχανικών και Τεχνολογίασ Υπολογιςτών

Τομέασ Συςτημάτων Αυτομάτου Ελέγχου Μάθημα Προςαρμοςτικόσ Έλεγχοσ

12 | Σ ε λ ί δ α

x1 0 1 0 0

x2 0 0 7 0

x3 0 0 0 1

x4 0 0 0 0

b =

u1

x1 0

x2 0

x3 0

x4 1

c =

x1 x2 x3 x4

y1 1 0 0 0

d =

u1

y1 0

Continuous-time state-space model.

Δίδακε πξνεγνπκέλσο, όηη ην ζύζηεκα ζθαίξαο-ξάβδνπ είλαη έλα

ζύζηεκα ηύπνπ ΙΙ, ην νπνίν έρεη δύν πόινπο. Η αθόινπζε γξαθηθή

παξάζηαζε, ε νπνία εμήρζε ζην MatLab ζπκθσλεί κε όηη ππνζέζακε

πξνεγνπκέλσο.

pzmap(P_ball)

Page 13: Adaptive Control of Ball-Beam System

Πανεπιςτήμιο Πατρών Τμήμα Ηλεκτρολόγων Μηχανικών και Τεχνολογίασ Υπολογιςτών

Τομέασ Συςτημάτων Αυτομάτου Ελέγχου Μάθημα Προςαρμοςτικόσ Έλεγχοσ

13 | Σ ε λ ί δ α

Δπίζεο, ζέινπκε λα δνύκε ηελ απόθξηζε ηεο κπάιαο ζε κηα βεκαηηθή

είζνδν.

step(P_ball)

Page 14: Adaptive Control of Ball-Beam System

Πανεπιςτήμιο Πατρών Τμήμα Ηλεκτρολόγων Μηχανικών και Τεχνολογίασ Υπολογιςτών

Τομέασ Συςτημάτων Αυτομάτου Ελέγχου Μάθημα Προςαρμοςτικόσ Έλεγχοσ

14 | Σ ε λ ί δ α

Ο ιόγνο γηα ηνλ νπνίν πξαγκαηνπνηείηαη ν γεσκεηξηθόο ηόπνο είλαη γηα

λα εθηηκήζνπκε ηελ απόθξηζε ηνπ θιεηζηνύ βξόγρνπ από ηελ γξαθηθή

παξάζηαζε ησλ ξηδώλ ηνπ αλνηρηνύ-βξόγρνπ. Με ηελ πξόζζεζε

κεδεληθώλ ή πόισλ ζην ζύζηεκα (αληηζηαζκηζηήο) ν γεσκεηξηθόο ηόπνο

θαη θαη’επέθηαζε ε απόθξηζε θιεηζηνύ βξόγρνπ ζα ηξνπνπνηεζνύλ.

rlocus(P_ball)

Page 15: Adaptive Control of Ball-Beam System

Πανεπιςτήμιο Πατρών Τμήμα Ηλεκτρολόγων Μηχανικών και Τεχνολογίασ Υπολογιςτών

Τομέασ Συςτημάτων Αυτομάτου Ελέγχου Μάθημα Προςαρμοςτικόσ Έλεγχοσ

15 | Σ ε λ ί δ α

Παξαηεξνύκε όηη έρεη δύν πόινπο νη νπνίνη πεγαίλνπλ ζην άπεηξν θαηά

κήθνο ηνπ θαληαζηηθνύ άμνλα. Ο ιόγνο απόζβεζεο θαη ε ηδηνζπρλόηεηα

βξέζεθαλ ρξεζηκνπνηώληαο ηελ αθόινπζε εμίζσζε ε νπνία ζπζρεηίδεη

ην πνζνζηό ππεξύςσζεο θαη ην Ts: 21

% 100OS e

4

s

n

Ο ζθνπόο ηεο ρξήζεο ηνπ Bode δηαγξάκκαηνο είλαη ε εθηίκεζε ηεο

απόθξηζεο ηνπ θιεηζηνύ βξόγρνπ. Πξνζζέησληαο έλαλ ειεγθηή ζην

ζύζηεκα αιιάδνπκε ην Bode δηάγξακκα αλνηρηνύ βξόγρνπ, νπόηε

αιιάδεη θαη ε απόθξηζε θιεηζηνύ βξόγρνπ.

bode(P_ball)

Page 16: Adaptive Control of Ball-Beam System

Πανεπιςτήμιο Πατρών Τμήμα Ηλεκτρολόγων Μηχανικών και Τεχνολογίασ Υπολογιςτών

Τομέασ Συςτημάτων Αυτομάτου Ελέγχου Μάθημα Προςαρμοςτικόσ Έλεγχοσ

16 | Σ ε λ ί δ α