1.Introduction
在实现最优控制的过程中,发现状态空见表达式还需要离散化处理,因此为了使最优控制LQR算法尽快落地,又写了个针对于汽车动力学模型的状态空间表达式的离散化处理程序,也是用C语言实现的。
其中公式如下:
2.Coding Using C
按照上述公式,写了如下的代码,完整代码请参见我的github仓库https://github.com/JackJu-HIT/MatrixAandMatrixBDiscretization
/**
* @Function:Matrix A and Matrix B Discretization
* @Date:2022-07-20 19:46:01
* @Author:juchunyu
* @Last modified:juchunyu
*/
#include <stdio.h>