LQR轨迹跟踪算法Python/Matlab算法实现_LQRmatrix推导(2)