高斯伪谱法求解OCP

最优控制问题(Optimal Control Problem)的数值求解方法主要有间接法和直接法。间接法是根据极大值原理或者动态规划得到最优性的一阶必要条件，然后使用数值求解得到最优控制和轨迹。

间接法的优点是解的精度高，满足最优性的一阶必要条件。 缺点是收敛域很小，对初值估计要求高，且难以估计协态变量初值。而且需要求解状态方程和协态方程，增加了计算量， 算法鲁棒性较差。 对于复杂的系统， 推导一阶必要条件特别困难。
直接法是将原最优控制问题转化为非线性规划问题，然后采用非线性规划算法求解。由于不需要推导一阶必要条件，所以应用方便。直接法根据离散化变量的不同，主要可以分为只离散控制变量、只离散状态变量和同时离散控制变量和状态变量三类。第一类方法由于需要进行数值积分，计算量较大，这种算法的代表是打靶法和多段打靶法；第二类方法是微分包含法，它只离散状态变量，将控制约束转化为状态约束，可以降低变量个数，但是对于非线性比较复杂的状态方程，难以求出控制变量关于状态的显式表达式；第三类方法同时将状态变量和控制变量进行离散化，微分方程转化为代数约束条件， 这一类算法收敛速度较快，并且收敛半径大。[1]

配点法也是一种直接法，其包括欧拉法、Runge-Kutta法、Hermit-Simpson法和伪谱法。其中伪谱法包括Chebyshev伪谱法、Legendre伪谱法、Gauss伪谱法和Radau伪谱法。伪谱法因其计算效率和计算精度上的优势、良好的收敛性以及较低的初值敏感度在最优控制领域求解算法中倍受关注[2]。

Pseudospectral methods are a class of direct collocation where the optimal control problem is transcribed to a nonlinear programming problem (NLP) by parameterizing the state and control using global polynomials and collocating the differential-algebraic equations using nodes obtained from a Gaussian quadrature.[3]

1. 数学基本理论

1.1 Lagrange Polynomials

​ 假设给定$N+1$个数据点$(x_0,y_0),(x_1,y_1),\cdots ,(x_N,y_N)$，可以得到一个显示的，阶次为$N$插值多项式，称为Lagrange Polynomials(拉格朗日多项式)。
$$P(x)=\sum _{i=0}^N{y}_i{L}_i(x_i)\text{\hspace{1em}(1-1)}$$
其中，$L_i(x)$是Lagrange Polynomial的基函数。
$$\begin{gathered} L_i(x)=\prod _{j=0 \\ j\ne i}^N\frac{x-x_j}{x_i-x_j},i=0,1,2,\cdots ,N\text{\hspace{1em}(1-2)} \end{gathered}$$

1.2 Legendre Polynomials

Legendre Polynomials(勒让德多项式)是勒让德微分方程的解，勒让德多项式$P_n(x)$是$n$阶多项式，可用罗德里格公式表示为：
$$P_n(x)=\frac{1}{2^{n}n!}\frac{d^n}{d{x}^n}[(x^2-1{)}^n]\text{\hspace{1em}(1-3)}$$
相邻三个Legendre Polynomials具有递推关系：
$$(n+1)P_{n+1}=(2n+1)x{P}_n-n{P}_{n-1}\text{\hspace{1em}(1-4)}$$
Legendre Polynomials的微分递推关系可以用来计算Legendre Polynomials积分：
$$(2n+1)P_n=\frac{d}{dx}[P_{n+1}-P_{n-1}]\text{\hspace{1em}(1-5)}$$

1.3 Collocation Points

有三种常用的配点：Legendre-Gauss(LG)，Legendre-Gauss-Radau(LGR)和Legendre-Gauss-Lobatto(LGL) 。这些配点是Legendre Polynomials的根或者是Legendre Polynomials和其微分的根的线性组合。LG、LGR和LGL的配点分别分布在$\tau \in (-1,1)$，$\tau \in [-1,1)$或者$\tau \in (-1,1]$、$\tau \in [-1,1]$。假设$N$是配点的数目，$P_N(\tau )$是$N$阶Legendre Polynomial多项式，则有：

	多项式的根	分布	伪谱法分类
$LG$	$P_N(\tau )$	$\tau \in (-1,1)$	$Lobatto$
$LGR$	$P_{N-1}(\tau )+P_N(\tau )$	$\tau \in [-1,1)$或者$\tau \in (-1,1]$	$Gauss$
$LGL$	${\dot{P}}_{N-1}(\tau )$	$\tau \in [-1,1]$	$Radau$

1.4 Quadrature

采用高斯型数值积分计算近似计算积分：
$${\int }_{{\tau }_0}^{{\tau }_f}f(\tau )d\tau \approx \sum _{i=1}^N{w}_{i}f({\tau }_i)\text{\hspace{1em}(1-6)}$$
其中，$w_i$是quadrature weights，${\tau }_i$是quadrature points或者notes。$f(\tau )$采用Lagrange Polynomial形式有：
$${\int }_{{\tau }_0}^{{\tau }_f}f(\tau )d\tau ={\int }_{{\tau }_0}^{{\tau }_f}\sum _{i=0}^N{L}_i({\tau }_i)f({\tau }_i)d\tau \text{\hspace{1em}(1-7)}$$
由公式$(1-6)$和$(1-7)$可以得到：
$$w_i={\int }_{{\tau }_0}^{{\tau }_f}{L}_i({\tau }_i)d\tau ={\int }_{{\tau }_0}^{{\tau }_f}\prod _{k=1,k\ne i}^N\frac{\tau -{\tau }_k}{{\tau }_i-{\tau }_k}d\tau ,i=1,2,\cdots ,N\text{\hspace{1em}(1-8)}$$
如果${\tau }_i$是Legendre Polynomials的collocation points，可以得到：
$$w_i=\frac{2}{1-{\tau }_i^2}[{\dot{P}}_{}$$