捷浦智能多轴运动控制器 实现抑振控制简单示例

            dft_result[i] = 0;

        }

    }

    std::vector<double> filtered_signal(N);

    for (int n = 0; n < N; ++n) {

        double sum = 0;

        for (int k = 0; k < N; ++k) {

            double angle = 2 * M_PI * k * n / N;

            sum += dft_result[k] * std::cos(angle);

        }

        filtered_signal[n] = sum;

    }

    return filtered_signal;

}

int main() {

    std::vector<double> signal = {1, 2, 3, 4, 5, 6, 7, 8};

    double threshold = 10;

    std::vector<double> filtered_signal = remove_coherent_noise(signal, threshold);

    for (double value : filtered_signal) {

        std::cout << value << " ";

    }

    std::cout << std::endl;

    return 0;