강의노트 상태 변수 추정기 기반 제어기

강의노트 • 조회수 399 • 댓글 0 • 수정 11개월 전  
  • 상태변수 추정기
  • 상태방정식을 이용한 제어기 설계

상태변수 추정기 기반 제어기

기준 입력이 0인 경우

상태 변수 피드백 제어기를 구현하기 위해서 모든 상태 변수를 측정해야 한다.

상태 변수 피드백 제어기와 상태 변수 추정기를 결합한 상태 변수 추정기 기반 제어기(estimator based controller)를 만든다.

기준입력이 0이면

U=KX^ U=-K \hat X

→ K와 L을 구해야한다.

X˙=AXBKX^=(ABK)X+BK(XX^) \dot X =AX-BK \hat X = (A-BK)X + BK(X-\hat X)

X^˙=AX^BKX^+L(CXCX^)=LCX+(ABKLC)X^ \dot{ \hat X} = A \hat X -BK \hat X +L(CX - C \hat X)\\= LCX+(A-BK-LC) \hat X

상태 변수는 XXX^ \hat X, 전체 시스템의 차수는 원래 시스템 차수의 두배가 된다.

추정 오차 E=XX^E=X-\hat X를 상태 변수로 쓰면 위의 상태 변수 방정식은 좀더 다루기 편한 형태로 바뀜

E˙=X˙X^˙=AXBKX^LCX(ABKLC)X^=(ALC)(XX^)=(ALC)E \begin{aligned} \dot E &= \dot X - \dot{\hat X} \\ &=AX-BK \hat X-LCX-(A-BK-LC) \hat X \\ &=(A-LC)(X- \hat X) \\ &=(A-LC)E \end{aligned}

[X˙E˙]=[ABKBK0ALC][XE] \begin{bmatrix} \dot X \\ \dot E \end{bmatrix} = \begin{bmatrix} A-BK & BK \\ 0 &A-LC \end{bmatrix} \begin{bmatrix} X\\ E\end{bmatrix}

고유값을 구하기 위한 특성 방정식은

[sI00sI][ABKBK0ALC]=sI(ABK)BK0sI(ALC)=0 \begin{vmatrix}\begin{bmatrix}sI &0 \\ 0 &sI \end{bmatrix} -\begin{bmatrix} A-BK & BK \\ 0 &A-LC \end{bmatrix} \end{vmatrix}=\begin{vmatrix} sI-(A-BK) &-BK \\ 0 &sI-(A-LC) \end{vmatrix} =0

sI(ABK)sI(ALC)=0 |sI-(A-BK)||sI-(A-LC)|=0

전체 폐루프 시스템이 가지는 극점은 다음 두 개의 특성 방정식의 근들을 모두 함께 모아 놓은 것과 같다.

sI(ABK)=0|sI-(A-BK)|=0 → 상태 변수 피드백 제어기

sI(ALC)=0|sI-(A-LC)|=0 → 상태 추정기

상태 변수 피드백 제어기와 상태 변수 추정기는 서로 영향을 미치지 않으며 별도로 설계할 수 있다.

{X^˙=(ABKLC)X^+LYU=KX^ \begin{cases} \dot{\hat X}=(A-BK-LC)\hat X + LY \\ U=-K\hat X \end{cases}

U(s)Y(s)=K[sI(ABKLC)]1L \dfrac{U(s)}{Y(s)}=-K[sI-(A-BK-LC)]^{-1}L

기준입력이 0이 아닌 경우

U=R0KX^U=R_0-K\hat X

Df(s)D_f(s)는 정상 상태 오차를 줄이거나 없애기 위한 피드퍼워드 항

X˙=AX+B(R0KX^)(1) \tag{1} \dot X=A X+B(R_0-K\hat X)

X^˙=AX^+B(R0KX^)+L(CXCX^)=LCX+(ALC)X^+B(R0KX^)(2) \tag{2} \dot{\hat X}=A\hat X+B(R_0-K\hat X)+L(CX -C\hat X) \\= LCX+(A-LC)\hat X+B(R_0-K\hat X)

E=XX^E=X-\hat X이라하고 (1)에서 (2)를 빼면

E˙=(ALC)E\dot E=(A-LC)E

E(s)=[sI(ALC)]1e(0) E(s)=[sI-(A-LC)]^{-1}e(0)

Y(s)=CX(s)Y(s)=CX(s)

Y(s)R0(s)=C[sI(ABK)]1B \dfrac{Y(s)}{R_0(s)}=C[sI-(A-BK)]^{-1}B

이전 글
마지막 글입니다.
댓글
댓글로 소통하세요.