相关代码 |
|
3 矩阵A: -2 1 -1 0 0 0 0 -2 0 0 0 0 10 -10 0 0 0 0 0 0 0 0 0 0 0 0 0 0 0 0 0 0 0 0 0 0 矩阵B: 1 0 0 0 0 0 0 -1 0 0 0 0 0 0 0 0 0 0 0 0 0 0 0 0 0 0 0 0 0 0 0 0 0 0 0 0 矩阵△: 0 0 0 0 0 0 0 0 0 0 0 0 0 0 0 0 0 0 0 0 0 0 0 0 0 0 0 0 0 0 0 0 0 0 0 0 状态反馈增益阵K: 5 -5 1 0 0 0 输入向量V: 2 1 0 PID参数: 5 0.05 1