添加滤波算法及完善功图计算算法（未完成）