传感器数据滤波算法中值滤波算法代码

中值滤波是一种常见的信号滤波算法，可以用于去除传感器数据中的噪声。其基本思想是将一组数据按照大小排序，然后取中间值作为滤波结果。下面是一段简单的中值滤波算法的代码示例：

#define WINDOW_SIZE 5

// 中值滤波算法
int median_filter(int* data, int size) {
    int i, j, temp;
    int window[WINDOW_SIZE];
    
    // 处理边界情况
    if (size < WINDOW_SIZE) {
        return data[size / 2];
    }
    
    // 依次处理每个数据点
    for (i = 0; i < size; i++) {
        // 构建窗口
        for (j = 0; j < WINDOW_SIZE; j++) {
            if (i + j < size) {
                window[j] = data[i + j];
            }
        }
        
        // 对窗口内的数据进行排序
        for (j = 0; j < WINDOW_SIZE - 1; j++) {
            for (int k = j + 1; k < WINDOW_SIZE; k++) {
                if (window[j] > window[k]) {
                    temp = window[j];
                    window[j] = window[k];
                    window[k] = temp;
                }
            }
        }
        
        // 取中间值作为滤波结果
        data[i] = window[WINDOW_SIZE / 2];
    }
    
    return 0;
}

该函数的输入参数为一个整型数组data和数组大小size，表示输入的原始数据和数据点的数量。函数首先定义了一个窗口大小为5的数组window，用于存储每个窗口内的数据，然后依次处理每个数据点。对于每个数据点，函数构建一个窗口，将当前数据点及其前后两个数据点放入窗口数组中。然后使用冒泡排序算法对窗口内的数据进行排序，最后将窗口中间的值作为滤波结果，并将结果存储回原始数据数组中。最后，函数返回0，表示滤波完成。注意，该函数假设输入数据已经去除了常见的噪声，因此只需要简单的中值滤波即可。如果需要更加复杂的滤波算法，可以考虑使用其他滤波方法。