Least Squares Solution for Discrete Time Nonlinear Stochastic Optimal Control Problem with Model-Reality Differences ()
1. Introduction
Stochastic dynamical system is a practical system in modeling and simulating the real-world problems. The behavior of the fluctuation, which is caused by the effect of noise disturbance in the dynamical system to represent the real situation, rises to the attention of many researchers. See for examples, [1] - [8] . As such, optimization and control of the stochastic dynamical system are a challenging topic. In the past decades, the research outcomes, both for theoretical results and development of the algorithms, are well-defined [9] [10] [11] [12] [13] . In general, the real processes, which are modeled into the stochastic optimal control problem, are mostly nonlinear process. Their actual models in natural could be necessary unknown. Applying the linear model, including the Kalman filtering theory, to solve the stochastic optimal control problems, in particular, for nonlinear case, give a simplification methodology instead [14] [15] [16] [17] .
Recently, the integrated optimal control and parameter estimation (ICOPE) algorithm, which solves the linear model-based optimal control problem iteratively, is proposed in the literature [18] [19] . The purpose of this algorithm is to provide the optimal solution of the discrete time nonlinear stochastic optimal control problem with the different structure and parameters. In this algorithm, the adjusted parameters are added into the model used so as the differences between the real plant and the model used can be calculated, in turn, update the optimal solution of the model used during the computation procedure. The integration of system optimization and parameter estimation is the main feature of this algorithm, where the principle of model-reality differences and the Kalman filtering theory are incorporated. Once the convergence is achieved, the iterative solution approximates to the correct optimal solution of the original optimal control problem, in spite of the model-reality differences. However, increasing the accuracy of the model output to track the real output would be necessary required.
In this paper, an efficient matching scheme, which diminishes the adjusted parameters, is established deliberately. In our approach, the model-based optimal control problem is simplified from the discrete-time nonlinear stochastic optimal control problem. Then, this model-based optimal control problem is reformulated into the input-output equations. During the formulation of the input-output equations, the Hankel matrix and the observability matrix are constructed. These matrices capture the characteristic of the model used into the output measurement. By virtue of this, the least square optimization problem is introduced. From the validation of the first order necessary condition, the normal equation is resulted and the optimal control law is updated accordingly on the recursion formula. As a result of this, the sum squares of the output error could be minimized demonstratively. Hence, the efficiency of the algorithm proposed is highly presented.
The rest of the paper is organized as follows. In Section 2, the discrete time nonlinear stochastic optimal control problem and its simplified model-based optimal control problem are described. In Section 3, the system optimization with the least squares updating scheme is discussed. The computation procedure is summarized as the iterative algorithm. In Section 4, the current converter problem is illustrated and the result is demonstrated. Finally, some concluding remarks are made.
2. Problem Description
Consider a general class of dynamical system given by
(1a)
(1b)
where
, and
, are, respectively, the control sequence, the state sequence and the output sequence. The terms
, and
, are, respectively, process noise sequences and output noise sequences. Both of these noise sequences are the stationary Gaussian white noise sequences with zero mean and their covariance matrices are given by
and
, respectively, where
is a
positive definite matrix and
is a
positive definite matrix. In addition,
is an
process noise coefficient matrix,
represents the plant dynamics and
is the output measurement channel.
Here, the aim is to find the control sequence
, such that the following cost function
(2)
is minimized over the dynamical system in Equation (1), where
is the terminal cost and
is the cost under summation. The cost function
is the scalar function and
is the expectation operator. It is assumed that all functions in Equations (1) and (2) are continuously differentiable with respect to their respective arguments.
The initial state is
where
is a random vector with mean and variance given, respectively, by
and
.
Here,
is an
positive definite matrix. It is assumed that the initial state, the process noise and the measurement noise are statistically independent.
This problem is regarded as the discrete-time nonlinear stochastic optimal control problem and is referred to as Problem (P). Notice that the structure of Problem (P) is complex, and the exact solution of Problem (P) is, in general, unable to be obtained. In view of these, Problem (P) is proposed to be solved via solving a simplified model-based optimal control problem iteratively. For this purpose, let this simplified model-based optimal control problem, which is referred to as Problem (M), be given below:
subject to (3)
where
, and
, are, respectively, the expected state sequence and the expected output sequence. Here,
is an
state transition matrix,
is an
control coefficient matrix,
is a
output coefficient matrix, whereas
and
are
positive semi-definite matrices,
is a
positive definite matrix and
is the scalar cost function.
Notice that only solving Problem (M) actually would not give the optimal solution of Problem (P). However, by establishing an efficient matching scheme, it is possible to approximate the true optimal solution of Problem (P), in spite of model-reality differences. This could be done iteratively.
3. System Optimization with Least Square Updating Scheme
Now, let us define the Hamiltonian function for Problem (M) as follows:
. (4)
Then, from Equation (3), the augmented cost function becomes
(5)
where
is the appropriate multiplier to be determined later.
Applying the calculus of variation [20] [21] [22] to the augmented cost function in Equation (5), the following necessary conditions are resulted:
1) Stationary condition:
(6)
2) Costate equation:
(7)
3) State equation:
(8)
with the boundary conditions
and
.
3.1. State Feedback Optimal Control Law
The following theorem expresses the feedback control law based on the state that can be used in solving Problem (M).
Theorem 1. For the given Problem (M), the optimal control law is the feedback control law defined by
(9)
where
(10)
(11)
with the boundary condition
given. Here, the feedback control law is a linear combination of the states. That is, the optimal control is linear state-vari- able feedback.
Proof. From Equation (6), the stationary condition can be rewritten as
. (12)
Applying the sweep method [20] [21] [22] ,
, (13)
for
in Equation (12) to yield
. (14)
Taking Equation (8) into Equation (14), we have
.
After some algebraic manipulations, the feedback control law (9) is obtained, where Equation (10) is satisfied.
Now, substituting Equation (13) for
into Equation (7), the costate equation is written as
(15)
and considering the state Equation (8) in Equation (15), the costate equation becomes
. (16)
Hence, by applying the feedback control law (9) in Equation (16), and doing some algebraic manipulations, it could be seen that Equation (11) is satisfied after comparing the manipulation result to Equation (13). This completes the proof.
By substituting Equation (9) into Equation (8), the state equation becomes
(17)
and the model output is measured from
. (18)
In view of this, the calculation procedure for obtaining the feedback control law for Problem (M) is summarized below:
Algorithm 1: Feedback control algorithm
Data Given
.
Step 0 Calculate
, and
, from Equations (10) and (11), respectively.
Step 1 Solve Problem (M) that is defined by Equation (3) to obtain
, and
, respectively, from Equations (9), (17) and (18).
Step 2 Evaluate the cost function
from Equation (3).
Remarks:
1) Data A, B, C can be obtained by the linearization of the real plant
and the output measurement
from Problem (P).
2) In Step 0, the offline calculation is done for
, and
.
3) The solution procedure, which the dynamical system is solved in Step 1, and the cost function is evaluated in Step 2, is known as system optimization.
3.2. Least Squares Updating Scheme
Now, we define the output error
given by
(19)
where the model output (18) is reformulated as
. (20)
where
is a
coefficient matrix. Formulate Equation (20) as the following input-output equations [23] for
:
(21)
For simplicity, we have
(22)
where
and
In addition, define the objective function
, which represents the sum squares of error (SSE), given by
. (23)
Then, an optimization problem, which is referred to as Problem (O), is stated as follows:
Problem (O):
Find a set of the control sequence
, such that the objective function
is minimized.
It is obviously noticed that for solving Problem (O), Taylor’s theorem [24] [25] is applied to write the objective function
as the second-order Taylor expansion about the current
at iteration i as follows:
(24)
where the higher-order terms are ignored and the notation
represents the differential operator. The first-order condition in Equation (24) with respect to
is expressed by
. (25)
Rearrange Equation (25) to yield the normal equation,
. (26)
Notice that the gradient
is calculated from
(27)
and the Hessian of
is computed from
(28)
where
is the Jacobian matrix of
, and its entries are denoted by
(29)
From Equations (27) and (28), Equation (26) can be rewritten as
(30)
By ignoring the second-order derivative term, that is, the first term at the left-hand side of Equation (30), and define
, (31)
the normal equation given by Equation (26) is simplified to
. (32)
Then, we obtain the following updating recurrence relation,
(33)
with the initial
given, where
. (34)
Hence, Equations (33) and (34) are known as the least squares recursive equations, which are based on the Gauss-Newton recursion formula.
From the discussion above, the least-squares updating scheme for the control sequence is summarized below:
Algorithm 2: Least-squares updating scheme
Step 0 Given an initial
and the tolerance
. Set
.
Step 1 Evaluate the output error
and the Jacobian matrix
from Equations (19) and (29), respectively.
Step 2 Solve the normal equation from Equation (32) to obtain
.
Step 3 Update the control sequence by using Equation (33). If
, within a given tolerance
, stop; else set
and repeat from Step 1 to Step 3.
Remarks:
1) In Step 1, the calculation of the output error
and the Jacobian matrix
are done online, however, the Jacobian matrix
could be done offline if it is independent from
.
2) In Step 2, the inverse of
must be exist, and the value of
represents the step-size for the control set-point.
3) In Step 3, the initial
is calculated from (9). The condition
is required to be satisfied for the converged optimal control sequence. The following 2-norm is computed and it is compared with a given tolerance to verify the convergence of
:
. (35)
4) In order to provide a convergence mechanism for the state sequence, a simple relaxation method is employed:
(36)
where
, and
is the state sequence of the real plant.
4. Illustrative Example
In this section, an example of the direct current and alternating current (DC/AC) converter model is illustrated [26] [27] [28] . In this model, the real plant is a nonlinear dynamics structure and the output channel is a single output measurement, where the stationary Gaussian white noises are taken into the model. Since this model is a continuous time model, the simple discretization scheme is required. We define this model as Problem (P), while the simplified model, which is an expectation model, is employed as Problem (M). The cost function for both problems is a quadratic criterion function. The true solution of the original optimal control problem would be obtained by using the approach proposed and the solution procedure is implemented in the MATLAB environment.
Problem (P):
subject to
with the initial
. Here,
and
are Gaussian white noise sequences with their respective covariance given by
and
. The weighting matrices in the cost function are
,
and
.
Problem (M):
subject to
for
, with the sampling time
second.
The simulation result is shown in Table 1. The implementation of the algorithm proposed takes four iteration numbers to converge. The initial cost of 0.0429 unit is the value of cost function belong to Problem (M) before the iteration begins. After the convergence is achieved, the final cost of 116.9461 units is obtained. The original cost of 1.0881 × 103 is the value of cost function of the original optimal control problem. It is noticed that the cost reduction is 89.28 percent. The value of SSE, which is 8.046097 × 10−12, shows the smallest differences between the real output and the model output.
The trajectories of final control and real control are shown in Figure 1 and Figure 2, respectively. The final control takes into the consideration of noise sequence during the calculation, while the real control is free from the noise disturbance. Figure 3 shows the trajectories of final output and real output. It can be seen that the final output tracks closely to the real output. Figure 4 shows the trajectories of final state and real state, where they are statistically identical. Figure 5 and Figure 6 show, respectively, the output errors after and before iterations. The accuracy of the model output is increased due on the decrease of the output error.
5. Concluding Remarks
A computational algorithm, which is equipped with the efficient matching scheme, was discussed in this paper. The linear model-based optimal control problem, which is simplified from the discrete time nonlinear stochastic optimal control problem, was solved iteratively. During the calculation procedure, the model used was reformulated into the input-output equations. Then, the least squares optimization problem was introduced. By satisfying the first order necessary condition, the normal equation was solved such that the least squares
Figure 3. Trajectories of final output (−) and real output (*).
Figure 4. Trajectories of final state (−) and real state (+).
recursion formula could be established. In this way, the control policy could be updated iteratively. As a result of this, the sum squares of the output errors was minimized, which indicates the equivalent of the model output to the real output. For illustration, an example of the direct current and alternating current converter model was studied. The result obtained showed the accuracy of the algorithm proposed. In conclusion, the efficiency of the algorithm proposed was highly presented.
Figure 6. Output error before iteration.
Acknowledgements
The authors would like to thanks the Universiti Tun Hussein Onn Malaysia (UTHM) for financial supporting to this study under Incentive Grant Scheme for Publication (IGSP) VOT. U417. The second author was supported by the NSF (11501053) of China and the fund (15C0026) of the Education Department of Hunan Province.