直流信号采样软件滤波的问题？

求助！
        大家好，本人是DSP28335的菜鸟使用者，当前遇到一个软件滤波的问题，AD模块采样周期为40微秒，500个点为一组数据，想去掉其中最高的100个点和最低的100个点然后求均值进行软件滤波，传统排序计算量太多，不能使用，可是本人想来想去，怎么 简化都需要进行多次逐个点的比较操作，由于点比较多，太浪费时间了，简单尝试了一下，用这种方法，需要一百多个毫秒才能执行完这个函数，实在不妥。不知道各位高人有没有类似的软件经验。采样点确实比较多。
         问题的来源是由于采样信号上总有一个高频的干扰，因此想到了去掉大值的一部分，去掉小值的一部分进行滤波，采样周期40微秒不能变，500个点也尽量不要变。还请各位指点。多多益善，如果有其他软件滤波的方法就更好了！提前感谢各位的帮助！