kalman simplification

+ temporary matrices globally allocated
+ function matrix_float_mul_trans