自己写的追赶法解矩阵方程。用了c++的模板函数