Oud verslag voor Biquad.
Dependencies: Biquad HIDScope QEI angleandposition controlandadjust mbed
Fork of includeair by
filtervalues.h
00001 //////////////////////////////////////////////CONSTANTS 00002 ///////////////////Biquad #1 00003 const double gain_f1 = 9.6508098634474382e-01; 00004 const double A_f1[] = { 1.0000000000000000e+00 , -1.5685816307006708e+00 , 9.6424138386900704e-01}; 00005 const double B_f1[] = { 9.6508098634474382e-01 ,-1.5620271748674457e+00 , 9.6508103356874642e-01}; 00006 00007 ///////////////////Biquad #2 00008 const double gain_f2 = 1.0000000000000000e+00; 00009 const double A_f2[] = { 1.0000000000000000e+00 , -1.6110035772715345e+00 , 9.6592170561041857e-01}; 00010 const double B_f2[] = { 1.0000000000000000e+00 ,-1.6185451093340690e+00 , 9.9999995106731920e-01}; 00011 00012 ///////////////////Biquad #3 00013 const double gain_f3 = 9.6508098634473305e-01; 00014 const double A_f3[] = {1.0000000000000000e+00, -5.7396521780998500e-01 , 9.6488297638274156e-01}; 00015 const double B_f3[] = { 9.6508098634473305e-01 ,-5.9664124427116272e-01 , 9.6508097692557404e-01}; 00016 00017 ///////////////////Biquad #4 00018 const double gain_f4 = 1.0000000000000000e+00; 00019 const double A_f4[] = { 1.0000000000000000e+00 ,-6.4052826150899422e-01 , 9.6527942240059728e-01}; 00020 const double B_f4[] = {1.0000000000000000e+00, -6.1822926625254149e-01 , 1.0000000097599706e+00}; 00021 ///////////////////Biquad #5 00022 const double gain_f5 = 6.9977431651797473e-01; 00023 const double A_f5[] = { 1.0000000000000000e+00 ,-1.3072850288493236e+00 , 4.9181223722257517e-01}; 00024 const double B_f5[] = { 6.9977431651797473e-01, -1.3995486330359495e+00 , 6.9977431651797473e-01}; 00025 00026 ///////////////////Biquad #6 00027 const double gain_f6 = 2.4136223124304745e-08; 00028 const double A_f6[] = {1.0000000000000000e+00 ,-1.9540019616345168e+00 , 9.5461925134316061e-01}; 00029 const double B_f6[] = { 2.4136223124304745e-08 , 4.8272447728835386e-08 , 2.4136223466598214e-08}; 00030 00031 ///////////////////Biquad #7 00032 const double gain_f7 = 1.0000000000000000e+00; 00033 const double A_f7[] = { 1.0000000000000000e+00 , -1.9803238591642129e+00 , 9.8094946423345442e-01}; 00034 const double B_f7[] = { 1.0000000000000000e+00 , 1.9999999386720257e+00 , 9.9999998581827421e-01}; 00035 00036 00037 ////////////////////////////////////////////ARRAYS TO VARIABLES 00038 /////////////////Biquad #1 00039 const double a1_f1 = gain_f1*A_f1[1], 00040 a2_f1 = gain_f1*A_f1[2], 00041 b0_f1 = gain_f1*B_f1[0], 00042 b1_f1 = gain_f1*B_f1[1], 00043 b2_f1 = gain_f1*B_f1[2]; //filter coefficients filter 1 00044 double v1_f1_emg1=0 , 00045 v2_f1_emg1=0 , 00046 v1_f1_emg2=0 , 00047 v2_f1_emg2=0;//storage variables filter 1 00048 00049 /////////////////Biquad #2 00050 const double a1_f2 = gain_f2*A_f2[1], 00051 a2_f2 = gain_f2*A_f2[2], 00052 b0_f2 = gain_f2*B_f2[0], 00053 b1_f2 = gain_f2*B_f2[1], 00054 b2_f2 = gain_f2*B_f2[2]; //filter coefficients filter 2 00055 double v1_f2_emg1=0 , 00056 v2_f2_emg1=0 , 00057 v1_f2_emg2=0 , 00058 v2_f2_emg2=0;//storage variables filter 2 00059 00060 /////////////////Biquad #3 00061 const double a1_f3 = gain_f3*A_f3[1], 00062 a2_f3 = gain_f3*A_f3[2], 00063 b0_f3 = gain_f3*B_f3[0], 00064 b1_f3 = gain_f3*B_f3[1], 00065 b2_f3 = gain_f3*B_f3[2]; //filter coefficients filter 3 00066 double v1_f3_emg1=0 , 00067 v2_f3_emg1=0 , 00068 v1_f3_emg2=0 , 00069 v2_f3_emg2=0;//storage variables filter 3 00070 00071 /////////////////Biquad #4 00072 const double a1_f4 = gain_f4*A_f4[1], 00073 a2_f4 = gain_f4*A_f4[2], 00074 b0_f4 = gain_f4*B_f4[0], 00075 b1_f4 = gain_f4*B_f4[1], 00076 b2_f4 = gain_f4*B_f4[2]; //filter coefficients filter 4 00077 double v1_f4_emg1=0 , 00078 v2_f4_emg1=0 , 00079 v1_f4_emg2=0 , 00080 v2_f4_emg2=0;//storage variables filter 4 00081 00082 /////////////////Biquad #5 00083 const double a1_f5 = gain_f5*A_f5[1], 00084 a2_f5 = gain_f5*A_f5[2], 00085 b0_f5 = gain_f5*B_f5[0], 00086 b1_f5 = gain_f5*B_f5[1], 00087 b2_f5 = gain_f5*B_f5[2]; //filter coefficients filter 5 00088 double v1_f5_emg1=0 , 00089 v2_f5_emg1=0 , 00090 v1_f5_emg2=0 , 00091 v2_f5_emg2=0;//storage variables filter 5 00092 00093 /////////////////Biquad #6 00094 const double a1_f6 = gain_f6*A_f6[1], 00095 a2_f6 = gain_f6*A_f6[2], 00096 b0_f6 = gain_f6*B_f6[0], 00097 b1_f6 = gain_f6*B_f6[1], 00098 b2_f6 = gain_f6*B_f6[2]; //filter coefficients filter 6 00099 double v1_f6_emg1=0 , 00100 v2_f6_emg1=0 , 00101 v1_f6_emg2=0 , 00102 v2_f6_emg2=0;//storage variables filter 6 00103 00104 /////////////////Biquad #7 00105 const double a1_f7 = gain_f7*A_f7[1], 00106 a2_f7 = gain_f7*A_f7[2], 00107 b0_f7 = gain_f7*B_f7[0], 00108 b1_f7 = gain_f7*B_f7[1], 00109 b2_f7 = gain_f7*B_f7[2]; //filter coefficients filter 7 00110 double v1_f7_emg1=0 , 00111 v2_f7_emg1=0 , 00112 v1_f7_emg2=0 , 00113 v2_f7_emg2=0;//storage variables filter 7
Generated on Wed Jul 13 2022 08:14:56 by 1.7.2