Professional Documents
Culture Documents
Szakaszmodellek
Szakaszmodellek
Hidraulikus ellenállás
Ha egy csőszakasz két oldalán a nyomás p1 illetve p 2 , a keresztmetszet pedig
megváltozik, akkor áramlás alakul ki, és a villamos ellenállás mintájára
definiálhatjuk az R hidraulikus ellenállást a w = ρv tömegáram [kg / s ] és a
p1 − p 2 nyomáskülönbség [ N / m 2 ] = [ Pa] között a következő összefüggéssel,
ahol α anyagfüggő:
1
w = ( p1 − p 2 )1 / α
R
Speciálisan, ha a külső (ambiens) nyomás p a , egy tartály alján a kiömlő nyílás
előtt a nyomás p1 = p a + mgh , ahol mgh a hidrosztatikus nyomás, a kiömlő nyílás
után pedig a nyomás p a , akkor a Bernoulli-törvényt a tartály aljára és a kiömlő
nyilás utánra felírva kapjuk, hogy
p a + ρgh = p a + ρv 2 / 2 ⇒ v = 2 gh
p1 − p a = ρv 2 / 2 ⇒ v = 2 / ρ ( p1 − p a )1 / 2 ⇒ w = ρv = 2 ρ ( p1 − p a )1 / 2
R = 1/ 2ρ a szabad kiömlő nyílás hidraulikus ellenállása
Lagrange-egyenlet
Mechanikai rendszerek dinamikus modelljét energia megfontolások alapján is fel
lehet állítani. Ha a rendszer (teljes és minimális) azonosítására a q i általánosított
koordinátákat használjuk (amely például robotok esetén lehet az egyes csuklók
szögelfordulása [rad], vagy elmozdulása [m], a csukló típusától függően), akkor az
általánosított koordináták irányában ható ún. általánosított erők (robotok rotációs
csuklói esetén nyomatékok [Nm], transzlációs csuklók esetén erők [N]) az
energiákkal a következő módon függenek össze:
d ∂K ∂K ∂P
− + = Qi Lagrange-egyenlet
dt ∂q& i ∂q i ∂q i
Newton–Euler-egyenletek
Ismeretes a középiskolából, hogy tömegpont esetén Newton 2. axiomája szerint
ma = F írja le a tömegpont lineáris mozgását, ahol a a gyorsulás és F az m
tömegű tömegpontra ható erő.
Hasonlóan, ha egy m tömegpont egy l hosszúságú súlytalan rúd végén foglal
helyet, és egy tengely körül foroghat, akkor forgását a Θε = τ összefüggés írja le,
ahol ε a szöggyorsulás, τ a forgatónyomaték (torque) és Θ = ml 2 a tengelyre
vonatkozó tehetetlenségi (inercia) nyomaték.
III. Szabályozott szakasz mintamodellek 39
m = ∫ dm
m rc = ∫ ρ dm
T
⎡ 0 − ρz ρy ⎤ ⎡ 0 − ρz ρy ⎤
⎢ ⎥ ⎢ ⎥
J = ∫ [ ρ ×] [ ρ ×]dm = ∫ ⎢ ρ z
T
0 − ρx ⎥ ⎢ ρz 0 − ρ x ⎥ dm =
⎢− ρ y ρx 0 ⎥⎦ ⎢⎣− ρ y ρx 0 ⎥⎦
⎣
⎡ ρ y2 + ρ z2 − ρ x ρ y − ρxρz ⎤ ⎡ Ix − I xy − I xz ⎤
⎢ ⎥ ⎢ ⎥
= ∫ ⎢ − ρ x ρ y ρ x + ρ z − ρ y ρ z ⎥dm =: ⎢− I xy
2 2
Iy − I yz ⎥
⎢−ρ ρ − ρ y ρ z ρ x2 + ρ y2 ⎥⎦ ⎢ − I xz − I yz I z ⎥⎦
⎣ x z ⎣
⎡ 0 − az a y ⎤⎛ bx ⎞
⎢ ⎥⎜ ⎟
a × b = [a×]b = ⎢ a z 0 − a x ⎥⎜ by ⎟
⎢− a y
⎣ ax 0 ⎥⎦⎜⎝ bz ⎟⎠
1
v& = −ω × v + Fext
m Newton–Euler-egyenletek
ω& = − J −1[ω ×]Jω + J −1τ ext
Súrlódás nélkül:
m&x& = F − bx& − kx ⇒ m&x& + bx& + kx = F
A jobb oldalon álló nem aktív erők esetében figyelembe vettük, hogy például ha x
pozitív irányban megnő, akkor a rugó megnyúlik, ezért a rugóerő visszafelé húzza a
tömeget, azaz a mozgással szemben negatív irányban hat, tehát − kx . Innen a
differenciálegyenletre egyszerűen átrendezéssel át lehet térni. Az állapotegyenletet
az első egyenletből m -mel való osztással nyerjük.
Állapotegyenlet: x& = Ax + Bu , y = Cx
x = ( x, x& ) T =: ( x1 , x 2 ) T , y = x = x1 , u = F
x&1 = x& = x 2
k b 1 k b 1
x& 2 = &x& = − x − x& + F = − x1 − x 2 + u
m m m m m m
⎡ 0 1 ⎤ ⎡ 0 ⎤
A=⎢ ⎥ , B=⎢ ⎥, C = [1 0]
⎣− k / m − b / m⎦ ⎣1 / m ⎦
Súrlódás esetén:
m&x& = F − bx& − kx − µmgx& = F − (b + µmg ) x& − kx
A mozgásegyenlet visszavezethető az előző esetre b := b + µmg helyettesítéssel. A
modell felhasználható mozdonyból és vasúti kocsiból álló együttes modellezésére is.
42 Lantos-Kiss-Harmati: Szabályozástechnika gyakorlatok
III.2 ábra. Diszkből és flexibilis R/W fejből álló rendszer egyszerűsített vázlata
x = (ϕ 1 , ϕ&1 , ϕ 2 , ϕ& 2 ) T , u = τ m , y = ϕ 2
⎡ 0 1 0 0 ⎤ ⎡ 0 ⎤
⎢− k / I − b / I k / I1 b / I1 ⎥⎥ ⎢1 / I ⎥
x& = ⎢ 1 1
x + ⎢ 1 ⎥ u , y = [0 0 1 0] x
⎢ 0 0 0 1 ⎥ ⎢ 0 ⎥
⎢ ⎥ ⎢ ⎥
⎣ k / I2 b / I2 − k / I2 − b / I2 ⎦ ⎣ 0 ⎦
III. Szabályozott szakasz mintamodellek 43
k k
A tipikus paraméterek I 1 = 1 , I 2 = 0.1 , 0.09 ≤ k ≤ 0.4 , 0.038 ≤ b ≤ 0 .2 ,
10 10
minden SI egységben értendő.
Állapotegyenlet: x& = Ax + Bu , y = Cx
x = (ϕ 2 , ϕ& 2 , ϕ 1 , ϕ&1 ) T , u = τ m , y = ϕ 2
⎡ 0 1 0 0 ⎤ ⎡ 0 ⎤
⎢− k / I − b / I2 k / I2 b / I2 ⎥⎥ ⎢ 0 ⎥
x& = ⎢ 2
x+⎢ ⎥u
⎢ 0 0 0 1 ⎥ ⎢ 0 ⎥
⎢ ⎥ ⎢ ⎥
⎣ k / I1 b / I1 − k / I1 − b / I1 ⎦ ⎣1 / I 1 ⎦
y = [1 0 0 0] x
i 2 dL Qi 2
m&y& = mg − f ( y, y& , i ) = mg + = mg − 2 ⇒ &y& + Qi 2 /( 2my 2 ) = g
2 dy 2y
d ( Li ) di
+ Ri = u ⇒ ( L0 + Q / y ) − (Qy& i / y 2 ) + Ri = u
dt dt
Innen rendezések után a nemlineáris rendszer állapotegyenlete a speciális
x& = a ( x) + b( x )u , y = Cx alakra hozható, ahol a ( x) az állapotváltozók nemlineáris
függvénye.
Állapotegyenlet: x& = a ( x) + b( x )u , y = Cx
x = ( y, y& , i ) T = ( x1 , x 2 , x 3 ) T , u , y
46 Lantos-Kiss-Harmati: Szabályozástechnika gyakorlatok
x&1 = x2
Qx32
x&2 = − +g
2mx12
R Qx x 1 Q
x&3 = − x3 + 2 2 3 + u , ahol L( x1 ) = + L0
L( x1 ) x1 L( x1 ) L( x1 ) x1
y = x1
⎛ x2 ⎞ ⎡ 0 ⎤
⎜ ⎟ ⎢ ⎥
⎟, b( x) = ⎢ 0 ⎥, C = [1 0 0]
2 2
a( x) = ⎜ − Qx3 /( 2mx1 ) + g
⎜ − R / L( x ) + Qx x /[ x 2 L( x )]⎟ ⎢⎣1 / L( x1 )⎥⎦
⎝ 1 2 3 1 1 ⎠
A busz 4 részre osztható 4 kerék esetén, minden rész egy összetett mechanikai
lengőrendszer, amely a karosszéria negyedrészének tömegéből (utasokkal együtt) és
III. Szabályozott szakasz mintamodellek 47
a kerék tömegéből áll, melyek függőleges helyzetét a felfelé mutató x1 és x 2 írja le.
Az útfelület és a kerék talppontja közötti távolság a mozgás közben az útfelülettel
együtt változó w (zavaró jellemző). Az egyes részek közötti kapcsolat flexibilis,
melyet viszkózus súrlódással és rugóállandóval modellezünk. A felfüggesztés aktív,
amelyet az F erő képvisel (beavatkozó jel).
A (negyed) karosszéria és a kerék tömegét rendre m1 és m 2 , az egyes
komponensek közötti flexibilis kapcsolatot a viszkózus súrlódási tényezők (b1 , b2 )
és rugóállandók (k1 , k 2 ) írják le. A mozgásegyenletek, felhasználva az akció-
reakció (D’Alambert-) elvet is, a következők:
m1 &x&1 = F − b1 ( x&1 − x& 2 ) − k1 ( x1 − x 2 )
m 2 &x&2 = − F + b1 ( x&1 − x& 2 ) + k1 ( x1 − x 2 ) − b2 ( x& 2 − w& ) − k 2 ( x 2 − w)
Rendezés után:
b1 k 1
&x&1 = − ( x&1 − x& 2 ) − 1 ( x1 − x 2 ) + F
m1 m1 m1
b k b k 1
&x&2 = 1 ( x&1 − x& 2 ) + 1 ( x1 − x 2 ) − 2 ( x& 2 − w& ) − 2 ( x 2 − w) − F
m2 m2 m2 m2 m2
Átalakítások szükségesek w& miatt, mivel az állapotegyenlet nem tartalmazhatja
egyetlen bemenő jel (így a w zavaró jel) deriváltját sem:
y1 := x1 − x 2
b k 1
&x&1 = − 1 y& 1 − 1 y1 + F
m1 m1 m1
b k b k 1
&x&2 = 1 y&1 + 1 y1 − 2 ( x& 2 − w& ) − 2 ( x 2 − w) − F
m2 m2 m2 m2 m2
⎛b b ⎞ ⎛k k⎞
&y&1 = &x&1 − &x&2 = −⎜⎜ 1 + 2 ⎟⎟ y&1 − ⎜⎜ 1 + 2
⎟⎟ y1 +
⎝ m1 m 2 ⎠ ⎝ m1 m 2
⎠
b k ⎛ 1 1 ⎞
+ 2 ( x& 2 − w& ) + 2 ( x 2 − w) + ⎜⎜ + ⎟⎟ F
m2 m2 ⎝ m1 m 2 ⎠
Integrálás után:
⎛b b ⎞ b
y& 1 = −⎜⎜ 1 + 2 ⎟⎟ y1 + 2 ( x 2 − w) +
⎝ m1 m 2 ⎠ m2
⎛k k ⎞ k ⎛ 1 1 ⎞
+ ∫ {−⎜⎜ 1 + 2 ⎟⎟ y1 + 2 ( x 2 − w) + ⎜⎜ + ⎟ F }dt
⎝ m1 m 2 ⎠ m2 ⎝ m1 m 2 ⎟⎠
1444444444 424444444444 3
y2
48 Lantos-Kiss-Harmati: Szabályozástechnika gyakorlatok
⎛k k ⎞ k ⎛ 1 1 ⎞
y& 2 = −⎜⎜ 1 + 1 ⎟⎟ y1 + 2 ( x 2 − w) + ⎜⎜ + ⎟⎟ F
⎝ m1 m 2 ⎠ m 2 ⎝ m1 m 2 ⎠
Végezzük el az x 2 = x1 − y1 behelyettesítést:
k2 ⎛k k k ⎞ ⎛ 1 1 ⎞ k
y& 2 = x1 − ⎜⎜ 1 + 1 + 2 ⎟⎟ y1 + ⎜⎜ + ⎟⎟ F − 2 w
m2 ⎝ m1 m 2 m 2 ⎠ ⎝ m1 m 2 ⎠ m2
b ⎛b b b ⎞ b
y& 1 = 2 x1 − ⎜⎜ 1 + 2 + 2 ⎟⎟ y1 + y 2 − 2 w
m2 ⎝ m1 m 2 m 2 ⎠ m2
b ⎛b b ⎞ b k 1
&x&1 = − 1 {−⎜⎜ 1 + 2 ⎟⎟ y1 + 2 ( x1 − y1 − w) + y 2 } − 1 y1 + F
m1 ⎝ m1 m 2 ⎠ m2 m1 m1
b1b2 ⎪⎧ b ⎛ b1 b b ⎞ k ⎪⎫ b 1 bb
= x1 + ⎨ 1 ⎜⎜ + 1 + 2 ⎟⎟ − 1 ⎬ y1 − 1 y 2 + F+ 1 2 w
m1 m 2 ⎪⎩ m1 ⎝ m1 m 2 m 2 ⎠ m1 ⎪⎭ m1 m1 m1 m 2
Állapotegyenlet: x& = Ax + Bu , y = Cx
x := ( x1 , x&1 , y1 , y&1 ) T , u = ( F , w) T , y = x1 − x 2 = y1
⎡ 0 1 0 0 ⎤ ⎡ 0 0 ⎤
⎢ b1b2 b1 ⎛ b1 b1 b ⎞ k b1 ⎥ ⎢ 1 b1b2 ⎥
⎢− 0 ⎜⎜ + + 2 ⎟⎟ − 1 − ⎥ ⎢ m1 m 2 ⎥
⎢ m1 m 2 m1 ⎝ m1 m 2 m 2 ⎠ m1 m1 ⎥
⎢
m1
⎥
A=⎢ b2
0
⎛b b b ⎞
− ⎜⎜ 1 + 1 + 2 ⎟⎟ 1 ⎥
⎥, B = ⎢
0 −
b2 ⎥
⎢ ⎢ m2 ⎥
⎢ m2 ⎝ m1 m 2 m 2 ⎠ ⎥ ⎢ ⎥
⎢ k2 ⎛k k k ⎞ ⎥ ⎢⎛⎜ 1 + 1 ⎞
⎟⎟ −
k2 ⎥
⎢ 0 − ⎜⎜ 1 + 1 + 2 ⎟⎟ 0 ⎥ ⎢⎜⎝ m1 m 2
⎣ ⎠ m 2 ⎥⎦
⎣⎢ m2 ⎝ m1 m 2 m 2 ⎠ ⎦⎥
C = [0 0 1 0]
Tipikus numerikus értékek busz esetén SI egységekben:
m1 = 2500 b1 = 350 k1 = 80000
m 2 = 320 b2 = 15020 k 2 = 500000
Tipikus elvárások a szabályozással szemben:
Az utazási komfort biztosításához 10sec-nál kisebb szabályozási idő és 5%-nál
kisebb túllövés biztosítása szükséges. Például ha a busz felfut az útegyenetlenségek
III. Szabályozott szakasz mintamodellek 49
miatt egy 10cm-es lépcsőre (azaz w(t ) = 0.1 ⋅ 1(t ) [m] zavaró jellemző hat a
rendszerre), akkor az oszcilláció maradjon ± 5mm között (azaz ± 0.005 m között),
és az oszcilláció szűnjön meg 5sec-on belül.
A kiömlőnyílás modellje:
1
wout = ( p1 − pa )1 / 2
R
R hidraulikus ellenállás
p1 (h) = p a + ρgh a nyomás a tartály alján
Aρh a tartályban lévő tömeg
1
Aρh& = win − wout = win − p1 ( h) − p a
R
Innen a tartály differenciálegyenlete:
1 1
h& = − p1 ( h) − pa + win
AρR Aρ
50 Lantos-Kiss-Harmati: Szabályozástechnika gyakorlatok
Az egyik médium tipikusan gőz (s, steam), a másik víz (w, water). A bemenetet
jelölje i az indexben, a kimeneten a hőmérsékletet nem jelöljük külön indexszel
(Ts , Tw ) .
q hőáram [ J / s ]
R termikus ellenállás
T hőmérséklet [C o ]
1 u
q = (T1 − T2 ) hőáram a médium 2 pontja között (villamos analógia: i = )
R R
C termikus kapacitás
du
CT& = q (villamos analógia: C =i)
dt
c v fajhő (állandó térfogaton) ⇒ C = mc v ⇒ q = mcv (T1 − T2 )
Az indexek ( s, w) megkülönböztetik a két médium jellemzőit.
A gőz esetén a hőáram és a szelepjellemzők a következők:
q s , i = ws c vs (Tsi − Ts ) gőz hőáram
As gőz bemeneti szelep hatásos felülete, bemenő jel
K s bemeneti szelep átviteli tényezője ⇒ ws = K s As
Gőzhőmérséklet változása:
1
C s T&s = K s As c vs (Ts , i − Ts ) − (Ts − Tw )
{ R
mc s vs
Vízhőmérséklet változása:
1
C wT&w = ww c vw (Tw, i − Tw ) + (Ts − Tw )
R
Rendezve ezeket a következő nemlineáris differenciálegyenleteket kapjuk:
1 1 K Ac
T&s = − Ts + Tw + s s vs (Ts , i − Ts )
RC s RC s Cs
m c 1
T&w = − w vw (Tw,i − Tw ) + (Ts − Tw )
Cw RC w
Állapotegyenlet: x& = A x + b( x, u ), y = Cx
⎛ As ⎞
⎛ Ts ⎞ ⎜ ⎟
x = ⎜⎜ ⎟⎟, u = ⎜ Ts ,i ⎟, y = Tw = x 2
⎝ Tw ⎠ ⎜T ⎟
⎝ w,i ⎠
⎡ 1 1 ⎤ ⎛ K s c vs ⎞
⎢− RC ⎥ ⎜ u1 (u 2 − x1 ) ⎟
⎥ , b ( x, u ) = ⎜ ⎟, C = [0 1]
RC s Cs
A=⎢ s
⎢ 1 m w vw ⎥
c ⎜ m c ⎟
⎜ −
w vw
u3 ⎟
⎢⎣ RC w Cw ⎦ ⎥ ⎝ Cw ⎠
52 Lantos-Kiss-Harmati: Szabályozástechnika gyakorlatok
Mechanikai mozgás:
Θ L q&& + ν 2Θ r q&& + ν 2 f r q& + f átt q& = τ
(Θ L + ν 2Θ r )q&& + ( f átt + ν 2 f r )q& = τ
⎛ Θ ⎞ ⎛ f ⎞
⎜Θ r + 2L ⎟ψ&& + ⎜ f r + átt2 ⎟ψ& = τ m = c 2 i r
⎝142ν43⎠ ⎝142ν43⎠
Θ f
Θψ&& + fψ& = c 2 i r
di r
Lr + Rr i r = u − c1ψ&
dt
x = (ψ ,ψ& , i r ) T , u , y = ψ = [1 0 0]x
⎡0 1 0 ⎤ ⎡ 0 ⎤
⎢
A = ⎢0 − f / Θ ⎥
c 2 / Θ ⎥ , B = ⎢⎢ 0 ⎥⎥
⎢⎣0 − c1 / Lr − Rr / Lr ⎥⎦ ⎢⎣1 / Lr ⎥⎦
Egyszerűsítés Lr ≈ 0 esetén:
u − c1ψ& cc c
ir = ⇒ τ m = c 2 i r = − 1 2 ψ& + 2 u
Rr Rr Rr
III. Szabályozott szakasz mintamodellek 55
c1c 2 c
Θψ&& + fψ& = − ψ& + 2 u
Rr Rr
x = (ψ ψ& ) T , u , y = ψ = x1
⎡0 1 ⎤ ⎡0 1 ⎤ ⎡ 0 ⎤ ⎡0 ⎤
A = ⎢0 − fRr + c1c 2 ⎥ = ⎢ ⎥ , B = ⎢ c2 ⎥=⎢ ⎥
⎢ ΘRr ⎦ ⎣ ⎥ 0 − a ⎦ ⎢ΘR ⎥ ⎣b ⎦
⎣ ⎣ r ⎦
Tömegközéppont:
⎛m ⎞
2
L⎜ + M ⎟
⎛m ⎞
L
2
ρA + ML = L⎜ + M ⎟ ⇒ l c = ⎝ ⎠
L
(m + M )l c = ∫ x1 ρAdx1 + ML =
0
2 ⎝2 ⎠ (m + M )
56 Lantos-Kiss-Harmati: Szabályozástechnika gyakorlatok
L3 ⎛m ⎞
L
I 1z = ∫ x12 ρAdx1 + ML2 = ρAML2 = L2 ⎜ + M ⎟
123 3 ⎝ 3 ⎠
0 dm
1
Kinetikus energia: K = I 1z ϕ& 2
2
Meghajtó nyomaték: τ
Lagrange-egyenlet:
d ∂K ∂K ∂P
− + =τ
dt ∂ϕ& ∂ϕ ∂ϕ
d
( I 1z ϕ& ) + (m + M ) gl c cos(ϕ ) = τ
dt
Differenciálegyenlet:
I 1 z ϕ&& + ( m + M ) gl c cos( ϕ ) = τ
Állapotegyenlet: x& = f ( x) + Bu , y = Cx = [1 0] x
x = (ϕ , ϕ& )T = ( x1 , x2 )T , u = τ , y = ϕ
⎛ x2 ⎞ ⎡ 0 ⎤
f ( x) = ⎜⎜ ⎟⎟ , B = ⎢ ⎥
⎝ ( m + M ) gl c cos(ϕ ) / I 1z ⎠ ⎣1 / I 1z ⎦
⎛ cc c ⎞
(Θ rν 2 + I 1z )q&& + ( f rν 2 + f átt )q& + (m + M ) gl c cos(q ) = νc 2 i r = ν ⎜⎜ − 1 2 ψ& + 2 u ⎟⎟
⎝ Rr Rr ⎠
Osszuk el az egyenletet ν -vel, térjünk át a motoroldali ψ változóra, és vezessük be
a következő jelöléseket:
III. Szabályozott szakasz mintamodellek 57
I 1z f átt 1⎛ cc ⎞ c
Θ =Θr + , f = fr + , k = (m + M ) gl c , a = ⎜⎜ f + 1 2 ⎟⎟ , b = 2
ν 2
ν 2
Θ⎝ Rr ⎠ RrΘ
x = (ψ , ψ& ) T , u , y = ψ
⎛ 0 ⎞
f ( x) = ⎜ − k ⎟ , B = ⎡0 ⎤
⎜ cos( x1 / ν ) − ax 2 ⎟ ⎢b⎥
⎝ νΘ ⎠ ⎣ ⎦
2L ϕ
F
m
gS ϕ −
m + M
Cϕ
(
F + MLS ϕ ϕ& 2 )
ϕ&& =
⎛ 4 MCϕ2 ⎞
L⎜ − ⎟
⎜3 m+M ⎟
⎝ ⎠
F
Cϕ
MLCϕ gS ϕ − m + M F + MLS ϕ ϕ&
2
( MLS ϕ ϕ& 2 )
&x& = − ⋅ + =
m+M m+M ⎛ 4 MCϕ2 ⎞ m+M
L⎜ − ⎟
⎜3 m+M ⎟
⎝ ⎠
A nemlineáris differenciálegyenlet rendezett alakja:
gS ϕ MS ϕ Cϕ Cϕ
ϕ&& = − ϕ& 2 − F
⎛ 4 MCϕ2 ⎞ ⎛ 4 MCϕ2 ⎞ ⎛ 4 MCϕ2 ⎞
L⎜ − ⎟ (m + M )⎜ − ⎟ ( m + M ) L⎜ − ⎟
⎜3 m+M ⎟ ⎜3 m+M ⎟ ⎜3 m+M ⎟
⎝ ⎠ ⎝ ⎠ ⎝ ⎠
⎛ ⎞
⎜ ⎟
MgS ϕ Cϕ MLS ϕ ⎜ MCϕ2 ⎟
&x& = − + ⋅ ⎜1 + ⎟ϕ& 2
⎛ 4 MCϕ2 ⎞ m + M ⎜ ⎛ 4 MCϕ2 ⎞⎟
(m + M )⎜ − ⎟ ⎜ (m + M )⎜ − ⎟⎟
⎜3 m+M ⎟ ⎜ ⎜3 m+M ⎟⎟
⎝ ⎠ ⎝ ⎝ ⎠⎠
⎛ ⎞
⎜ ⎟
⎜ MCϕ2 ⎟
1 ⎜ ⎟F
+ 1+
m+M ⎜ ⎛ 4 MCϕ2 ⎞⎟
⎜ ( m + M )⎜ − ⎟⎟
⎜ ⎜3 m+M ⎟⎟
⎝ ⎝ ⎠⎠
u − c1ψ& ν 2 c1c 2 νc
F = νc 2 i r = νc 2 =− x& + 2 u ,
Rr Rr Rr
III. Szabályozott szakasz mintamodellek 61
Az egyensúlyi helyzet körüli változásokat is x, x& , ϕ , ϕ& -vel jelölve kapjuk, hogy
Θ + ML2 = ML2 4 / 3 miatt a kiindulási Lagrange-egyenletek alapján
(m + M ) &x& + MLϕ&& = F
4
ML&x& + (Θ + ML2 )ϕ&& = MLgϕ ⇒ &x& + Lϕ&& = gϕ
3
miatt
−1
⎡m + M ML ⎤ ⎡4 ⎤
⎢ 4 ⎥ =
1 ⎢ 3 L − ML ⎥
⎢⎣ 1 L
3 ⎥⎦
4 ⎢ ⎥
(m + L) L − ML ⎣ − 1 m + M ⎦
3
⎡4 ⎤
=
1 ⎢ 3 L − ML ⎥
⎛4 M ⎞ ⎢ −1 m + M ⎥
( m + M ) L⎜ − ⎟⎣ ⎦
⎝3 m+M ⎠
és ezért
62 Lantos-Kiss-Harmati: Szabályozástechnika gyakorlatok
⎛ &x& ⎞ ⎡4 ⎤⎛ F ⎞
⎜⎜ ⎟⎟ =
1 ⎢ 3 L − ML ⎥⎜ ⎟ ,
⎝ ϕ&& ⎠ (m + M ) L⎛⎜ 4 − M ⎞ ⎢ − 1 m + M ⎥⎜⎝ gϕ ⎟⎠
⎟⎣ ⎦
⎝3 m+M ⎠
vagy részletesen
4
&x& = −
Mg
ϕ+ 3 F
⎛4 M ⎞ ⎛4 M ⎞
(m + M )⎜ − ⎟ (m + M )⎜ − ⎟
⎝3 m+M ⎠ ⎝3 m+M ⎠
g 1
ϕ&& = ϕ− F
⎛4 M ⎞ ⎛4 M ⎞
L⎜ − ⎟ ( m + M ) L⎜ − ⎟
⎝3 m+M ⎠ ⎝3 m+M ⎠
Az eredmény összhangban van a nemlineáris differenciálegyenletből közvetlenül
következő alakkal is (így annak ellenőrzésére szolgálhat), ha figyelembe vesszük,
hogy
⎛4 M ⎞ 4
( m + M )⎜ − ⎟+M
M ⎝ 3 m+M ⎠ 3
1+ = =
⎛4 M ⎞ ⎛4 M ⎞ ⎛4 M ⎞
( m + M )⎜ − ⎟ (m + M )⎜ − ⎟ ⎜ − ⎟
⎝3 m+M ⎠ ⎝3 m+M ⎠ ⎝3 m+M ⎠
Mivel DC motor és Lr ≈ 0 esetén F lineárisan függött u -tól és x& -tól, ezért alakja
a linearizálás után is a régi marad és behelyettesíthető F helyére a linearizált
ν 2 c1c 2 νc
alakban: F := − x& + 2 u .
Rr Rr
1 ν 2 c1c 2 g
c= ⋅ , d=
⎛4 M ⎞ Rr ⎛4 M ⎞
( m + M ) L⎜ − ⎟ L⎜ − ⎟
⎝3 m+M ⎠ ⎝3 m+M ⎠
III. Szabályozott szakasz mintamodellek 63
4
3 νc 2 1 νc 2
e= ⋅ , f = ⋅
⎛4 M ⎞ Rr ⎛4 M ⎞ Rr
(m + M )⎜ − ⎟ ( m + M ) L⎜ − ⎟
⎝3 m+M ⎠ ⎝3 m+M ⎠
x = ( x, x& , ϕ , ϕ& )T , u , y = ( x , ϕ )T
⎡0 1 0 0⎤ ⎡ 0 ⎤
⎢0 − a − b ⎥ ⎢ e ⎥
A=⎢
0⎥
, B=⎢ ⎥ , C = ⎡1 0 0 0⎤
⎢0 0 0 1⎥ ⎢ 0 ⎥ ⎢0 0 1 0 ⎥
⎣ ⎦
⎢ ⎥ ⎢ ⎥
⎣0 c d 0⎦ ⎣− f ⎦
s 2 x = − asx − bϕ + eu ⎡ s 2 + as b ⎤⎛ x ⎞ ⎛ e ⎞
⇒ ⎢ ⎥⎜ ⎟ = ⎜ ⎟⎟u
s ϕ = csx + dϕ − fu
2
⎣ − cs s 2 − d ⎦⎜⎝ ϕ ⎟⎠ ⎜⎝ − f ⎠
es 2 + bf − de
W x ,u ( s ) =
s ( s 3 + as 2 − ds − ad + bc)
− fs 2 + (ce − af ) s − fs + (ce − af )
Wϕ ,u ( s ) = = 3
s ( s + as − ds − ad + bc) s + as 2 − ds − ad + bc
3 2
ahonnan következik
l Fψ& + vG sin( β )
tan(δ W − α F ) = .
vG cos( β )
ahonnan következik
l Fψ& − v G sin( β )
tan(α R ) = .
v G cos( β )
l Fψ&
α F = δW − β −
vG
l Rψ&
α R = −β + .
vG
⎛Cβ ⎞
⎜ ⎟
vCOG = ⎜ Sβ ⎟ vG
⎜ 0 ⎟
⎝ ⎠
III. Szabályozott szakasz mintamodellek 67
⎛Cβ
⎞ ⎛− Sβ ⎞ ⎡0 − ψ& 0⎤ ⎛ C β ⎞
⎜⎟ ⎜ ⎟ ⎢ ⎜ ⎟
a COG = v&COG + ω × v COG = ⎜ Sβ
⎟ v&G + ⎜ C β &
⎟ β v G + ⎢ψ& 0 0⎥⎥⎜ S β ⎟ vG =
⎜ 0
⎟ ⎜ 0 ⎟ ⎢⎣ 0 0 0⎥⎦⎜⎝ 0 ⎟
⎝⎠ ⎝ ⎠ ⎠
⎡C β − vG S β ⎤ ⎛− Sβ ⎞
⎢ ⎥ ⎛ v&G ⎞ ⎜ ⎟
= ⎢Sβ v G C β ⎥ ⎜⎜ & ⎟⎟ + ⎜ C β ⎟ψ&v G
β
⎢⎣ 0 0 ⎥⎦ ⎝ ⎠ ⎜⎝ 0 ⎟⎠
Közbenső lépések:
−1 −1
⎡C β − vG S β ⎤ ⎡a b ⎤ 1 ⎡ d − b ⎤ 1 ⎡v G C β vG S β ⎤
⎢S =: ⎢ = ⎥=
⎣ β vG C β ⎥⎦ ⎥
⎣c d ⎦
⎢ ⎢
ad − bc ⎣− c a ⎦ v G ⎣ − S β C β ⎥⎦
⎛ v&G ⎞ 1 ⎡vG C β vG S β ⎤ 1 ⎛ Fx ⎞ 1 ⎡v G C β v G S β ⎤ ⎛ − S β ⎞
⎜⎜ ⎟⎟ = ⎢ ⎜ ⎟+ ⎥⎜⎜ C ⎟⎟v Gψ&
&
⎝ β ⎠ vG ⎣ − S β C β ⎥⎦ mv ⎜ Fy ⎟ v ⎢ − S β
⎝ ⎠ 1G4 ⎣ 4444C2β 4⎦4 ⎝ 4β4⎠43
⎛ 0⎞
−⎜⎜ ⎟⎟ψ&
⎝1⎠
⎛ l ψ& ⎞
FtF = cFα F = cF ⎜⎜ δ w − β − F ⎟⎟
⎝ vG ⎠
⎛ l ψ& ⎞
FtR = cRα R = cR ⎜⎜ − β + R ⎟⎟
⎝ vG ⎠
68 Lantos-Kiss-Harmati: Szabályozástechnika gyakorlatok
1 ⎛ l ψ& ⎞
v&G = {FlF cos(δ w − β ) − c F ⎜⎜ δ w − β − F ⎟⎟ sin(δ w − β ) +
mv ⎝ vG ⎠
⎛ l ψ& ⎞
+ c R ⎜⎜ − β + R ⎟⎟ sin( β ) + FlR cos( β )}
⎝ vG ⎠
1
β& = −ψ& + {FlF sin(δ W − β ) − FlR sin( β ) +
mv vG
l ψ& l ψ&
+ c F (δ W − β − F ) cos(δ W − β ) + c R ( − β + R ) cos( β )}
vG vG
1 1 ⎛ l ψ& ⎞
ψ&& = τ z = {l F FlF sin(δ W ) + l F c F ⎜⎜ δ w − β − F ⎟⎟ cos(δ w ) −
Iz Iz ⎝ vG ⎠
⎛ l ψ& ⎞
−l R c R ⎜⎜ − β + R ⎟⎟ cos( β )}
⎝ vG ⎠
x = ( β ,ψ& ) T , u = δ W , y = ψ&
⎡ cF + cR cRlR − cF lF ⎤ ⎡ cF ⎤
− − 1⎥
⎛ β& ⎞ ⎢ β ⎢ ⎥
mv v G2 ⎥ ⎛⎜ ⎞⎟ + ⎢ mv v G ⎥ δ W = Ax + Bu
mv vG
⎜ ⎟=⎢
⎜ψ&& ⎟ ⎢ c l − c l
⎝ ⎠ c R l R2 + c F l F ⎥ ⎜⎝ψ& ⎟⎠ ⎢ c F l F ⎥
2
⎢
R R F F
− ⎥ ⎢⎣ I zz ⎥⎦
⎣ I zz I zz vG ⎦
III. Szabályozott szakasz mintamodellek 69
c F ( I zz + m v l F2 ) + c R ( I zz + m v l R2 ) (c + c R )(l F + l R ) 2 + m v v G2 (c R l R − c F l F )
s2 + s+ F =0
m v v G I zz m v v G2 I zz
c F c R (l F + l R )
Astat = v G .
(c F + c R )(l F + l R ) 2 + mv vG2 (c R l R − c F l F )
2
c F c R (l f + l R ) 2
v char :=
m v (c R l R − c F l F )
2
( v char negatív is lehet, ha c R l R − c F l F < 0 ), amely szoros kapcsolatban van a
statikus átviteli tényezővel:
1 vG
Astat = ⋅ .
l F + l R 1 + v G / v char
2 2
Tipikus járműveknél v char értéke 68 és 112 km/h között van. A kis karakterisztikus
sebesség arra utal, hogy a jármű alulkormányozott.