1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
|
function [k_x,k_w,K_x,K_w,Us0,J_uu,J_ux,J_uw,J_xx,J_xw,J_ww,A_u] = \
ppp_lin_quad (A,B,C,D,tau,Q,R)
## usage:[k_x,k_w,K_x,K_w,Us0,J_uu,J_ux,J_uw,J_xx,J_xw,J_ww,A_u] =
## ppp_lin_quad (A,B,C,D,tau,Q,R)
##
##
## Steady-state Linear Quadratic solution
## using Algebraic Riccati equation (ARE)
[P,A_u,A_w] = ppp_are (A,B,C,D,Q,R);
## PPP solution
[k_x,k_w,K_x,K_w,Us0,J_uu,J_ux,J_uw,J_xx,J_xw,J_ww] = \
ppp_lin(A,B,C,D,A_u,A_w,tau,Q,R,P);
A_u
|
|
>
>
>
>
>
|
|
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
|
function [k_x,k_w,K_x,K_w,Us0,J_uu,J_ux,J_uw,J_xx,J_xw,J_ww,A_u] = \
ppp_lin_quad (A,B,C,D,tau,Q,R,augment)
## usage:[k_x,k_w,K_x,K_w,Us0,J_uu,J_ux,J_uw,J_xx,J_xw,J_ww,A_u] =
## ppp_lin_quad (A,B,C,D,tau,Q,R)
##
##
## Steady-state Linear Quadratic solution
## using Algebraic Riccati equation (ARE)
[P,A_u,A_w] = ppp_are (A,B,C,D,Q,R);
## Augment with a constant term
if augment
A_u = ppp_aug(0,A_u);
endif
## PPP solution
[k_x,k_w,K_x,K_w,Us0,J_uu,J_ux,J_uw,J_xx,J_xw,J_ww] = \
ppp_lin(A,B,C,D,A_u,A_w,tau,Q,R,P);
endfunction
|