msp430单片机中如何设计50Hz陷波器？

2019-03-24 09:37发布

站内问答 / TI MCU
16073 3 1214
msp430前面的ADC采样率大概是300KHz，采样后的数据进入430单片机进行数据处理，但要先滤去50Hz工频干扰，求参考代码
此帖出自小平头技术问答
友情提示: 此问题已得到解决，问题已经关闭,关闭后问题禁止继续编辑，回答。
3条回答
a828378
2019-03-24 21:43
< ：TI_MSP430_内容页_SA7 -->
  1. #ifndef CNTL_2P2Z_F_H_
  2. #define CNTL_2P2Z_F_H_

  4. //*********** Structure Definition ********//

  6. // Second order control law using an IIR filter structure with programmable output saturation.
  7. // This macro uses CNTL_2P2Z_F structures to store coefficients & internal values.
  8. // The structures should be initialized with the supplied CNTL_2P2Z_F_INIT macro.
  9. // Within the structure the Max & Min parameters are the output bounds where as the IMin parameter
  10. // is used for saturating the lower bound while keeping an internal history.  The IMin parameter
  11. // should not be lower than -0.9.

  13. typedef struct {
  14.         // Coefficients
  15.         float32 Coeff_B2;
  16.         float32 Coeff_B1;
  17.         float32 Coeff_B0;
  18.         float32 Coeff_A2;
  19.         float32 Coeff_A1;

  21.         // Output saturation limits
  22.         float32 Max;
  23.         float32 IMin;
  24.         float32 Min;
  25. } CNTL_2P2Z_F_COEFFS;

  27. typedef struct {
  28.         float32 Out1;
  29.         float32 Out2;
  30.         // Internal values
  31.         float32 Errn;
  32.         float32 Errn1;
  33.         float32 Errn2;
  34.         // Inputs
  35.         float32 Ref;
  36.         float32 Fdbk;
  37.         // Output values
  38.         float32 Out;
  39. } CNTL_2P2Z_F_VARS;


  42. //*********** Macro Definition ***********//
  43. #define CNTL_2P2Z_F_MACRO(v, k)                                                                                                                               
  44.         /* Calculate error */                                                                                                                                       
  45.         k.Errn = k.Ref - k.Fdbk;                                                                                                                               
  46.         k.Out = (v.Coeff_A2*k.Out2) + (v.Coeff_A1 *k.Out1) + (v.Coeff_B2 *k.Errn2)                               
  47.                                         + (v.Coeff_B1 * k.Errn1) + (v.Coeff_B0 * k.Errn);                                               
  48.         /* Update error values */                                                                                                                               
  49.         k.Errn2 = k.Errn1;                                                                                                                                               
  50.         k.Errn1 = k.Errn;                                                                                                                                               
  51.         /* Determine new output */                                                                                                                               
  52.         k.Out = (k.Out < v.Max) ? k.Out : v.Max;                                                                                               
  53.         k.Out = (k.Out > v.IMin) ? k.Out : v.IMin;                                                                                               
  54.         /* Store outputs */                                                                                                                                               
  55.         k.Out2 = k.Out1;                                                                                                                                               
  56.         k.Out1 = k.Out;                                                                                                                                                       
  57.         /* Saturated output */                                                                                                                                       
  58.         k.Out = ((k.Out > v.Min) ? k.Out : v.Min);


  61. #endif /* CNTL_2P2Z_F_H_ */
复制代码我用的代码是这样的，来自TI的control SUITE的Solar LIB。
用下面的宏定义函数就可以了。两个结构体一个放了波波器的值一个放滤波参数。用之前记得两个结构体都初始化一下。
然后滤波器参数用MATLAB的fdatool生成一下就可以了。楼主可以试试看。

一周热门 更多>

相关问题

    相关文章