参考文章: https://www.sohu.com/a/233360876_466960 参考文章:https://blog.csdn.net/qq_34040067/article/details/114048308 我从网络上摘抄, 优化排版, 使其易于理解.
4.下一步是推导低通滤波公式(可以用同样的想法推导高通滤波公式)
PS:非专业分析仅供参考。如有错误,请纠正。
-电荷(库伦), -电容(F), -电阻(欧姆), -电压(V), -采样率(sampling rate, 次/秒) -截止频率(Hz), -圆周率(3.14…), -时间(秒)
这里再插一句, 先定义符号的意义对理解下一个数学公式非常有帮助. 很多文章都写了很多公式, 不解释符号的意义, 这样的文章是垃圾.建议以后一定要在文章中写公式中符号的意义和单位.
:
符号:Uo-输出电压,U-电容电压, Ui-输入电压
式1
Uo=U Ur
因为 C=Q/U, 所以U=Q/C 根据 U=Q/C, Q=I*t,I=U/R, t = 1/fs 得:
式2
Ur=(Ui-U) / (R*C*fs)
代入1得:
式3
Uo= U (Ui-U) / (R*C*fs)
不需要真正的电容电阻,因为我们是软件滤波器, 所以令k=1/(RCfs),代入得: Uo=U (Ui-U)*k
简化: 式4 Uo=k*Ui (1-k)*U
这里已经得到了滤波公式,如何通过截止频率获得k值?
根据 截止频率公式 fc=1/(2*Pi*R*C)
得: RC=1/(2*Pi*fc)
代入k=1 / (R * C * fs)得: 式5 k=(2*Pi*fc)/fs
C#版本完整,低通,高通滤波代码
using System; using System.Collections.Generic; using System.Linq; using System.Text; using System.Threading.Tasks; namespace Filter {
/// <summary> /// 模仿RC电路滤波的数字滤波算法 /// 参考文章 https://blog.csdn.net/qq_41848097/article/details/106124194 /// </summary> /// public class RCFilter {
float lastValue; float fc; float fs; float k; public RCFilter(float fc=200, float fs=100000 ) {
this.fc = fc; this.fs = fs;
this.k = (float)(fc * 2 * Math.PI / fs);
}
/// <summary>
/// RC低通滤波
/// Y(n)= a* X(n) + (1-a) * Y(n-1);
/// a = (fc * 2π) / fl
/// fc :截止频率
/// fl :采样频率
/// </summary>
/// <param name="data">数据源</param>
/// <param name="fc">截止频率</param>
/// <param name="fs">采样频率</param>
public float 低通滤波(ref float data )
{
//float k = (float)(fc * 2 * Math.PI / fs); //滤波系数
lastValue = this.k * data + (1 - this.k) * lastValue;
return lastValue;
}
/// <summary>
/// RC高通滤波
/// Y(n)= a* X(n) + (1-a) * Y(n-1);
/// a = (fc * 2π) / fl
/// fc :截止频率
/// fl :采样频率
/// </summary>
/// <param name="data">数据源</param>
/// <param name="fc">截止频率</param>
/// <param name="fs">采样频率</param>
public float 高通滤波(ref float data)
{
//float k = (float)(fc * 2 * Math.PI / fs); //滤波系数
lastValue = this.k * data + (1 - this.k) * lastValue;
//return data - lastValue;//如果直接返回滤波结果,滤波后图像是倒转的,在心电图等一些场合,需要将图像再镜像过来
return -( data - lastValue);//滤波结果
}
/// <summary>
/// RC低通滤波
/// Y(n)= a* X(n) + (1-a) * Y(n-1);
/// a = (fc * 2π) / fl
/// fc :截止频率
/// fl :采样频率
/// </summary>
/// <param name="data">数据源</param>
/// <param name="fc">截止频率</param>
/// <param name="fs">采样频率</param>
public static double[] 低通滤波(ref double[] data, double fc, double fs)
{
//————————————————
//版权声明:本文为CSDN博主「C# 学习者」的原创文章,遵循CC 4.0 BY-SA版权协议,转载请附上原文出处链接及本声明。
//原文链接:https://blog.csdn.net/qq_41848097/article/details/106124194
double k = fc * 2 * Math.PI / fs; //滤波系数
double[] outdata = new double[data.Length];
outdata[0] = data[0];
double lastValue = data[0];//必须取第一个, 取特殊值,0或1都不对.
for (int i = 1; i < data.Length; i++)
{
lastValue = k * data[i] + (1 - k) * lastValue;
outdata[i] = lastValue;
}
return data;
}
/// <summary>
/// RC低通滤波
/// Y(n)= a* X(n) + (1-a) * Y(n-1);
/// a = (fc * 2π) / fl
/// fc :截止频率
/// fl :采样频率
/// </summary>
/// <param name="data">数据源</param>
/// <param name="fc">截止频率</param>
/// <param name="fs">采样频率</param>
public static float[] 低通滤波 (ref float[] data, float fc, float fs)
{
//————————————————
//版权声明:本文为CSDN博主「C# 学习者」的原创文章,遵循CC 4.0 BY-SA版权协议,转载请附上原文出处链接及本声明。
//原文链接:https://blog.csdn.net/qq_41848097/article/details/106124194
if (data == null || data.Length == 0)
{
return data;
}
float k = (float)( fc * 2 * Math.PI / fs); //滤波系数
float[] outdata = new float[data.Length];
outdata[0] = data[0];
float lastValue = data[0];//必须取第一个, 取特殊值,0或1都不对.
for (int i = 1; i < data.Length; i++)
{
lastValue = k * data[i] + (1 - k) * lastValue;
outdata[i] = lastValue;
}
return data;
}
/// <summary>
/// RC高通滤波
/// Y(n)= a* X(n) + (1-a) * Y(n-1);
/// a = (fc * 2π) / fl
/// fc :截止频率
/// fl :采样频率
/// </summary>
/// <param name="data">数据源</param>
/// <param name="fc">截止频率</param>
/// <param name="fs">采样频率</param>
public static float[] 高通滤波(ref float[] data, float fc, float fs)
{
//————————————————
//版权声明:本文为CSDN博主「C# 学习者」的原创文章,遵循CC 4.0 BY-SA版权协议,转载请附上原文出处链接及本声明。
//原文链接:https://blog.csdn.net/qq_41848097/article/details/106124194
if (data == null || data.Length == 0)
{
return data;
}
float k = (float)(fc * 2 * Math.PI / fs); //滤波系数
float[] outdata = new float[data.Length];
outdata[0] = data[0];
float lastValue = data[0];//必须取第一个, 取特殊值,0或1都不对.
for (int i = 1; i < data.Length; i++)
{
lastValue = k * data[i] + (1 - k) * lastValue;
outdata[i] = data[i] - lastValue; // 高通这里是原始值减去上次的值, 低通是直接输出lastvalue
//outdata[i] = data[i] - lastValue;//如果直接返回滤波结果,滤波后图像是倒转的,在心电图等一些场合,需要将图像再镜像过来
outdata[i] = 0-( data[i] - lastValue); //滤波结果
}
return data;
}
/// <summary>
/// RC高通滤波
/// Y(n)= a* X(n) + (1-a) * Y(n-1);
/// a = (fc * 2π) / fl
/// fc :截止频率
/// fl :采样频率
/// </summary>
/// <param name="data">数据源</param>
/// <param name="fc">截止频率</param>
/// <param name="fs">采样频率</param>
public static double[] 高通滤波(ref double[] data, double fc, double fs)
{
//————————————————
//版权声明:本文为CSDN博主「C# 学习者」的原创文章,遵循CC 4.0 BY-SA版权协议,转载请附上原文出处链接及本声明。
//原文链接:https://blog.csdn.net/qq_41848097/article/details/106124194
if (data == null || data.Length == 0)
{
return data;
}
double k = (double)(fc * 2 * Math.PI / fs); //滤波系数
double[] outdata = new double[data.Length];
outdata[0] = data[0];
double lastValue = data[0];//必须取第一个, 取特殊值,0或1都不对.
for (int i = 1; i < data.Length; i++)
{
lastValue = k * data[i] + (1 - k) * lastValue;
outdata[i] = data[i] - lastValue; // 高通这里是原始值减去上次的值, 低通是直接输出lastvalue
//outdata[i] = data[i] - lastValue;//如果直接返回滤波结果,滤波后图像是倒转的,在心电图等一些场合,需要将图像再镜像过来
outdata[i] = 0 - (data[i] - lastValue); //滤波结果
}
return data;
}
}
}
C#版有两种用法, 一种是直接调用静态方法处理整个数组, 另外一种用法是new 一个新对象, 下面的用法是new 新对象的用法.
static RCFilter rcFilterA1;
static RCFilter rcFilterB1;
static RCFilter rcFilterA2;
static RCFilter rcFilterB2;
public static void 初始化滤波器(ref float fs)
{
rcFilterA1 = new RCFilter(GD.低通滤波截止频率, fs);//一阶滤波
rcFilterA2 = new RCFilter(GD.低通滤波截止频率, fs);//二阶滤波
rcFilterB1 = new RCFilter(GD.低通滤波截止频率, fs);
rcFilterB2 = new RCFilter(GD.低通滤波截止频率, fs);
}
public static void main(){
GD.CurrentCycle_A[i] = rcFilterA1.低通滤波(ref GD.CurrentCycle_A[i]);
GD.CurrentCycle_A[i] = rcFilterA2.低通滤波(ref GD.CurrentCycle_A[i]);
GD.CurrentCycle_B[i] = rcFilterB1.低通滤波(ref GD.CurrentCycle_B[i]);
GD.CurrentCycle_B[i] = rcFilterB2.低通滤波(ref GD.CurrentCycle_B[i]);
}
静态变量一次性使用的方法
float[] data = new float[]{
1,2,3,3,43,43,.....};
RCFilter.低通滤波(ref data,100,50);//将data中高于50hz的信号都过滤掉
RCFilter.低通滤波(ref data,100,60);//将data中高于60hz的信号都过滤掉
RCFilter.高通滤波(ref data,100,10);//将data中低于10hz的信号都过滤掉
RCFilter.高通滤波(ref data,100,20);//将data中低于20hz的信号都过滤掉
如果即执行了高通又执行了低通, 就变成带通了.
注意RC滤波会引起相位后移, 如果需要计算相位的,请注意相位位移问题. 我这个里面执行的次数越多相位后移的也越多.