修复了卡尔曼的一些bug
更改了矩阵向量惩罚的bug