论文部分内容阅读
直接配点法通过对控制变量和状态变量都进行离散将轨迹优化问题转化为非线性规划(NLP)问题。为了提高NLP的求解效率,需要利用其偏导数的稀疏特性并建立偏导数的高效计算方法。本文研究了局部配点法离散得到的NLP的一阶偏导数的稀疏特性,建立了一阶偏导数的高效计算方法。推导了NLP的目标函数梯度和约束雅克比矩阵的数学表达式,得到了NLP偏导数的稀疏型,并且将NLP的偏导数分解为原始轨迹优化问题的偏导数。由于原始轨迹优化问题的约束和变量的数量远少于NLP的约束和变量的数量,从而显著减小了NLP的一阶偏导数的计算量。