1.add kfilter code
2.refine filter so that data become more stable, have better resistance against noise.