opencv频域滤波 C++实现陷波滤波器

1、首先看效果
输入：

输出：
2、基本思路
对分析输入图像的频谱（幅度谱）：

放大：


明显看到频谱中心外有4个峰值，找到坐标，干掉即可（陷波滤波思想）。
找出坐标：

得出4个关键坐标：
(278,313)
(264,313)
(250,201)
(236,201)
matlab坐标以1开始，而C++ opencv数组下标以0开始
所以在C++代码上处理坐标应为：
(277, 312)
(263, 312)
(249, 200)
(235, 200)
本方案notch_filter处理时直接直接赋0，一般来说要赋予周围值。
完整代码：

#include <iostream>
#include<opencv2/opencv.hpp>

using namespace cv;
using namespace std;

void dft_shift(Mat& ds)
{
   
	int cx = ds.cols / 2;
	int cy = ds.rows / 2;
	Mat q0 = ds(Rect(0, 0, cx, cy));<