3. 샘플치 퍼지 조정기 설계
이 장에서는 상태 양자화를 가진 샘플치 퍼지 조정기를 이용한 쿼드로터의 조정기 설계 조건을 LKF를 기반으로 선형 행렬 부등식의 형태로 제안한다.
이때 제어기 입력에서 참조 값 r(tk)=0으로 가정한다.
정리 1 : 아래의 선형 행렬 부등식들을 만족하는 양의 한정 행렬 ˉP∊ℝnx×nx, ˉU∊ℝnx×nx, ˉR1∊ℝnx×nx, Q1ij∊ℝ5nx×5nx,
E1ij∊ℝ5nx×5nx, Q2ij∊ℝ6nx×6nx, E2ij∊ℝ6nx×6nx, 대칭 행렬 ˉR3∊ℝnx×nx, ˉR6∊ℝnx×nx,
임의의 행렬 ˉKj∊ℝnu×nx, 그리고 전열 계수 행렬 ˉR2∊ℝnx×nx, ˉR4∊ℝnx×nx, ˉR5∊ℝnx×nx,
ˉGv∊ℝnx×nx, v∊I5, ˉYlij∊ℝnx×nx,
l∊I5가 존재하면 쿼드로터 폐루프 시스템 (7)은 지수적으로 안정하다.
여기서 α, ϵ1, ϵ2, ρ, |wp(p(t))−wp(p(tk))|≤μp는 주어진 양의 스칼라이고, Mlij=Qlij−Elij, Nlij=Qlij+Elij,
ˉΦ1ij(ˉh)=ˉΨij+ˉΛ1(ˉh), ˉΦ2ij(ˉh)=[ˉΨij+ˉΛ2(ˉh)∗√ˉhˉYij−e−2αh2ˉU],
ˉΨij=[ˉΨ11ij∗∗∗∗ˉΨ21ijˉΨ22ij∗∗∗ˉΨ31ijˉΨ32ijˉΨ33∗∗ˉΨ41ijˉΨ42ij0nx×nxˉΨ44∗ˉΨ51ijˉΨ52ijˉΨ53ijˉΨ54ˉΨ55],
ˉΛ1(ˉh)=[ˉΛ11(ˉh)∗∗∗∗ˉΛ21(ˉh)ˉΛ22(ˉh)∗∗∗ˉΛ31(ˉh)ˉΛ32(ˉh)ˉhˉU∗∗ˉΛ41(ˉh)2αˉhˉG4ˉhˉG3ˉΛ44(ˉh)∗ˉhˉR4ˉhˉR50nx×nx0nx×nxˉΛ551(ˉh)],
ˉΛ2(ˉh)=[0nx×nx∗∗∗0nx×nx−ˉhe−2αh2ˉR3∗∗02nx×nx02nx×nx02nx×2nx∗0nx×nxˉhe−2αh2ˉR50nx×2nxˉΛ552(ˉh)],
ˉYij=[ˉY1ijˉY2ijˉY3ijˉY4ijˉY5ij],
ˉΨ11ij=2αˉP−ˉG1+ˉGT12+ˉYT1ij+ˉY1ij+ϵ1AiˉW+ϵ1ˉWTATi,
ˉΨ21ij=ˉG1−ˉG2+ˉYT2ij−ˉY1ij+ϵ1ˉKTiBTi,
ˉΨ22ij=ˉG2+ˉGT2−ˉG1+ˉGT12−ˉYT2ij−ˉY2ij+2LˉDL,
ˉΨ31ij=ˉPT+ˉYT3ij−ϵ1ˉWT+ϵ2AiˉW,
ˉΨ32ij=−ˉYT3ij+ϵ2BiˉKj,
ˉΨ33=−ϵ2(ˉWT+ˉW), ˉΨ41ij=−ˉG3+ˉYT4ij,
ˉΨ42ij=−e−2αh2ˉR2−ˉG4−ˉYT4ij,
ˉΨ44=−e−2αh2h2ˉR1−ˉG5+ˉGT52,
ˉΨ51ij=ϵ1ˉKTjBTi+ˉYT5ij, ˉΨ52ij=−ˉYT2ij,
ˉΨ53ij=ϵ2ˉKTjBTi,
ˉΨ54=−e−2αh2ˉR4, ˉΨ55=−2ˉD,
ˉΛ11(ˉh)=ˉhˉR1+αˉh(ˉG1+ˉGT1)+ˉh(ˉG3+ˉGT3),
ˉΛ21(ˉh)=ˉhˉR2+2αˉh(−ˉG1+ˉG2)+ˉhˉGT4,
ˉΛ22(ˉh)=ˉhˉR3+2αˉh(−ˉG2−ˉGT2+ˉG1+ˉGT12),
ˉΛ31(ˉh)=ˉhˉG1+ˉGT12, ˉΛ32(ˉh)=ˉh(−ˉGT1+ˉGT2),
ˉΛ41(ˉh)=2αˉhˉG3+ˉhˉG5+ˉGT52,
ˉΛ44(ˉh)=αˉh(ˉG5+ˉGT5),
ˉΛ551(ˉh)=ˉh(ˉR6+ˉRT6),
ˉΛ552(ˉh)=−ˉhe−2αh2(ˉR6+ˉRT6),
ˉh∊{h1,h2},
마지막으로 조정 이득 행렬은 다음의 식을 통해 얻을 수 있다.
Kj=ˉKjˉW−1.
증명 : 다음의 LKF를 고려하자.
여기서
V1(t)=xT(t)Px(t),
V2(t)=(tk+1−t)∫ttke2α(s−t)[x(s)x(tk)f(x(tk))]T[R1∗∗R2R3∗R4R5R6][x(s)x(tk)f(x(tk))]ds,
V3(t)=(tk+1−t)[x(t)x(tk)∫ttkx(s)ds]TG[x(t)x(tk)∫ttkx(s)ds],
V4(t)=(tk+1−t)∫ttke2α(s−t)˙xT(s)U˙x(s)ds,
G=[G1+GT12∗∗−G1+G2−G2−GT2+G1+GT12∗G3G4G5+GT52],
지수적 안정성을 고려한 V(t)를 시간에 대해 미분하여 다음과 같은 식을 유도한다.
여기서 α>0은 임의의 주어진 스칼라이다.
이제,
식 (14) 우변의 첫째 항에 Jensen 부등식
(21)을 적용하면, 다음을 얻을 수 있다.
한편, V_{3}(t)를 미분하면 다음을 얻는다.
다음으로 V_{4}(t)의 미분은 다음과 같다.
이제 다음의 널 항 (null term)을 고려하자. 앞으로는 식의 간결한 표현을 위해 w_{i}(p(t))와 w_{j}(p(t_{k}))를
각각 \bar{w}_{i}와 \hat w_{j}로 표기한다.
여기서 \xi^{T}(t)=\begin{bmatrix}x^{T}(t)& x^{T}(t_{k})&\dot x^{T}(t)&\int_{t_{k}}^{t}x^{T}(s)ds
&f^{T}\left(x(t_{k})\right)\end{bmatrix}, Y_{ij}=\begin{bmatrix}Y_{1ij}& Y_{2ij}&
Y_{3ij}& Y_{4ij}& Y_{5ij}\end{bmatrix}이다.
또한, 다음의 잘 알려진 부등식을 고려하자.
X^{T}Y+Y^{T}X\le\sigma X^{T}X+\sigma^{-1}Y^{T}Y,
여기서 X, Y는 임의의 행렬이고 \sigma는 양의 스칼라이다. 식 (18) 우변의 둘째 항은 위의 부등식과 보조 정리 2, Jensen 부등식을 이용하여 다음과 같이 정리할 수 있다.
식 (19)을 (18)에 적용하여 다음을 얻을 수 있다.
또한, 식 (17)에 (20)를 적용하여 다음의 부등식을 얻을 수 있다.
한편, 적절한 차원을 가지는 임의의 행렬 W_{1}과 W_{2}에 대해 다음의 널 항이 성립한다.
마지막으로, 식 (5)로부터 임의의 대각 행렬 D>0에 대한 다음의 식을 얻을 수 있다.
여기서 L=diag\left\{l_{1},\: l_{2},\:\ldots ,\:l_{n_{x}}\right\}이다.
따라서 이상의 내용을 정리하면, 식 (13)-(23)을 통해 다음이 성립함을 알 수 있다.
이에 더해, 식 (24) 우변 첫째 항에 diag\left\{\bar{W}^{T},\:\bar{W}^{T},\:\bar{W}^{T},\:\bar{W}^{T},\:\bar{W}^{T}\right\}와
diag\{\bar{W},\:\bar{W},\:\bar{W},\:\bar{W},\:\bar{W}\}으로 congruence transformation을
적용하고, 샘플링의 상·하한치의 convex sum으로 정리하면 다음을 얻는다.
또한, 식 (24) 우변 둘째 항에 diag\left\{\bar{W}^{T},\:\bar{W}^{T},\:\bar{W}^{T},\:\bar{W}^{T},\:\bar{W}^{T}\right
.\left. ,\:\bar{W}^{T}\right\}와 diag\{\bar{W},\:\bar{W},\:\bar{W},\:\bar{W},\:\bar{W},\:\bar{W}\}으로
congruence transformation와 Schur complement를 적용하고, convex sum으로 정리하면 다음과 같다.
여기서 W_{1}=\epsilon_{1}W, W_{2}=\epsilon_{2}W, \bar{W}=W^{-1}, \bar{K}_{j}=K_{j}\bar{W},
\bar{P}=\bar{W}^{T}P\bar{W}, \bar{U}=\bar{W}^{T}U\bar{W}, \bar{D}=\bar{W}^{T}D\bar{W},
\bar{R}_{1}=\bar{W}^{T}R_{1}\bar{W}, \bar{R}_{2}=\bar{W}^{T}R_{2}\bar{W}, \bar{R}_{3}=\bar{W}^{T}R_{3}\bar{W},
\bar{R}_{4}=\bar{W}^{T}R_{4}\bar{W}, \bar{R}_{5}=\bar{W}^{T}R_{5}\bar{W}, \bar{R}_{6}=\bar{W}^{T}R_{6}\bar{W},
\bar{G}_{1}=\bar{W}^{T}G_{1}\bar{W}, \bar{G}_{2}=\bar{W}^{T}G_{2}\bar{W}, \bar{G}_{3}=\bar{W}^{T}G_{3}\bar{W},
\bar{G}_{4}=\bar{W}^{T}G_{4}\bar{W}, \bar{G}_{5}=\bar{W}^{T}G_{5}\bar{W}, \bar{Y}_{1ij}=\bar{W}^{T}Y_{1ij}\bar{W},
\bar{Y}_{2ij}=\bar{W}^{T}Y_{2ij}\bar{W}, \bar{Y}_{3ij}=\bar{W}^{T}Y_{3ij}\bar{W},
\bar{Y}_{4ij}=\bar{W}^{T}Y_{4ij}\bar{W}, \bar{Y}_{5ij}=\bar{W}^{T}Y_{5ij}\bar{W}.
식 (24)-(26)과 보조 정리 1을 통해 선형 행렬 부등식 (8)-(11)이 성립하면, 다음의 부등식이 만족한다는 것을 알 수 있다.
\dot V(t)+2\alpha V(t)\le 0, t∊[t_{k},\: t_{k+1}).
t∊[t_{k},\: t_{k+1})에 대해 위의 부등식을 적분하면 다음을 얻을 수 있다.
식 (12)의 V(t)와 식 (27)을 기반으로 하여, 다음을 얻을 수 있다.
따라서, r(t_{k})=0 일 때 다음의 부등식으로 샘플치 퍼지 조정기 기반의 쿼드로터 폐루프 시스템 (7)의 평형점이 지수적으로 점근 안정하다는
것을 알 수 있다.
\|x(t)\| \leq \sqrt{\frac{V(0)}{\lambda_{\min }(P)}} e^{-\alpha t} .
이것으로 증명을 마무리한다. ■
참고 1 : 본 논문에서 제안한 기법의 주요한 기여 사항은 다음과 같다.
1) 새로운 LKF 함수를 사용하여 쿼드로터 자세와 고도 시스템의 양자화를 고려한 샘플치 퍼지 조정기 설계 기법을 제안했다.
2) 양자화 때문에 발생하는 불확실성이 있는 환경에서 쿼드로터 시스템이 참조값을 잘 추종하기 위해 강인 제어 기법을 사용했으며, 양자화를 통해 전체
제어 시스템의 네트워크 부하를 줄일 수 있다.
3) 샘플링 간격의 상한과 하한치를 모두 고려하여 유연한 샘플링 조건을 통해 조정기 구현 시 하드웨어의 성능 요구도를 저감하였다.
4. 시뮬레이션 예제
이 장에서는 본 논문에서 제안하는 상태 양자화가 고려된 샘플치 퍼지 조정기의 타당성을 검증한다. 시뮬레이션에서 사용된 쿼드로터의 파라미터는 \left(m,\:
g,\: L,\: I_{x},\: I_{y},\: I_{z}\right)=(0.6,\: 9.81,\:0.175,\:\left. 2.32\times
10^{-2},\: 2.32\times 10^{-2},\: 4.00\times 10^{-2}\right)이다. 위치 시스템 제어 입력은 다음과 같다.
u_{p}(t)=\begin{bmatrix}u_{x}(t)\\u_{y}(t)\end{bmatrix},
여기서 u_{x}(t)와 u_{y}(t)는 적절히 설계된 제어 입력 값이고, 자세 시스템의 \phi(t)와 \theta(t)의 참조
값은 다음의 변환 식을 통해 얻을 수 있다.
\phi_{r}(t)=\sin^{-1}\left(s_{\psi}u_{x}(t)-c_{\psi}u_{y}(t)\right),
\theta_{r}(t)=\sin^{-1}\left(\dfrac{c_{\psi}u_{x}(t)+s_{\psi}u_{y}(t)}{\cos\left(r_{\phi}(t)\right)}\right),
시뮬레이션에서 사용된 값들은 \alpha_{a}=10, \alpha_{z}=2, \epsilon_{1}=1, \epsilon_{2}=0.01,
\rho_{a}=\rho_{z}=0.5, \mu_{a}=1, \mu_{z}=0.5, h_{1}=0.001, h_{2}=0.002이고,
초기 조건은 x_{a}(0)=\begin{bmatrix}0& 0& 0& 0& 0& 0\end{bmatrix}^{T}, x_{z}(0)=\begin{bmatrix}0&
0\end{bmatrix}^{T}, x_{p}(0)=\begin{bmatrix}0& 0& 0& 0\end{bmatrix}^{T}이고, 자세와
고도를 위한 조정기의 참조 값은 다음과 같이 설정했다. 이때 h_{1}과 h_{2}는 쿼드로터 하드웨어 성능을 고려하여 정해진 값이다.
r_{a}(t)=\begin{bmatrix}\phi_{r}(t)& 0&\theta_{r}(t)& 0& 0& 0\end{bmatrix}^{T},
0\le t<20,
r_{z}(t)=1, 0\le t<20.
그림. 1. 쿼드로터의 자세와 고도 시스템의 상태 응답
Fig. 1. The state response of the quadrotor attitude and altitude system
그림. 2. e_{\phi}(t)와 q(e_{\phi}(t))의 상태 응답
Fig. 2. The state response of e_{\phi}(t) and q(e_{\phi}(t)).
한편 자세 시스템의 참조 값을 결정하기 위해 내부적으로 위치 추종 값을 다음과 같이 설정했다.
r_{p}(t)=\begin{cases}
(r_{x},\:r_{y})=(1,\:0)& 0\le t<5\\
(r_{x},\:r_{y})=(1,\:1)& 5\le t<10\\
(r_{x},\:r_{y})=(0,\:1)& 10\le t<15\\
(r_{x},\:r_{y})=(0,\:0)& 15\le t<20
\end{cases}
정리 1을 통해 자세 시스템과 고도 시스템을 위한 조정기의 이득 행렬들을 MATLAB을 통해 결정했고, 결과는 다음과 같다.
K_{a1}=\begin{bmatrix}-70.15& -4.35& 0.03& 0.00& 0.39& 0.05\\ 0.03& 0.00& -70.15&
-4.35& -0.39& -0.05\\ -0.00& -0.00& 0.00& 0.00& -53.91& -2.65\end{bmatrix},
K_{a2}=\begin{bmatrix}-70.15& -4.35& -0.03& -0.00& -0.39& -0.05\\ -0.03& -0.00& -70.15&
-4.35& -0.39& -0.05\\ 0.00& 0.00& 0.00& 0.00& -53.91& -2.65\end{bmatrix},
K_{a3}=\begin{bmatrix}-70.15& -4.35& -0.03& -0.00& 0.39& 0.05\\ -0.03& -0.00& -70.15&
-4.35& 0.39& 0.05\\ -0.00& -0.00& -0.00& -0.00& -53.91& -2.65\end{bmatrix},
K_{a4}=\begin{bmatrix}-70.15& -4.35& 0.03& 0.00& -0.39& -0.05\\ 0.03& 0.00& -70.15&
-4.35& 0.39& 0.05\\ 0.00& 0.00& -0.00& -0.00& -53.91& -2.65\end{bmatrix},
K_{z1}=\begin{bmatrix}-40.14&-15.16\end{bmatrix}, K_{z2}=\begin{bmatrix}-40.98&-15.46\end{bmatrix}.
그림. 3. 쿼드로터의 위치 궤적(실선)과 위치 참조값(일점 쇄선)
Fig. 3. The trajectory of the position of the quadrotor(solid) and its reference (dash-dotted)
그림 1에서 \phi(t), \theta(t), \psi(t), z(t)는 쿼드로터 자세와 고도 시스템의 상태 변수이고, \phi_{r}(t),
\theta_{r}(t), \psi_{r}(t), z_{r}(t)는 참조 값이다. 그림 1을 통해 쿼드로터 자세 및 고도 시스템의 상태 변수가 추종 값에 수렴하는 것을 알 수 있다. 또한, 그림 2에서 e_{\phi}(t)와 q(e_{\phi}(t))의 시간 응답을 나타냈다. 그림 2를 통해 양자화의 결과로 제어기에 되먹임되는 값이 실제 값과 차이가 큼을 알 수 있고, 이러한 상황에서도 제안하는 방법을 통해 강인하게 제어가 됨을
알 수 있다. 일점 쇄선은 참조 값을 나타낸다. 마지막으로, 그림 3을 통해 제안하는 방법으로 쿼드로터 시스템이 참조 값을 잘 추종하는 것을 볼 수 있다.