A new algorithm for computing the state vaiable feedback gain

• 计算状态可变反馈增益的新算法