经典的近似联合对角化程序，试过了，效果很好。