From a9020d7b51b7dd5e4ce18f32477906ea5f69c7c0 Mon Sep 17 00:00:00 2001 From: Joel Fuster Date: Thu, 1 Jan 2015 11:56:41 -0500 Subject: [PATCH] Servo filtering test --- src/main/flight/notch_table.h | 102 ++++++++++++++++++++++++++++++++++ 1 file changed, 102 insertions(+) create mode 100755 src/main/flight/notch_table.h diff --git a/src/main/flight/notch_table.h b/src/main/flight/notch_table.h new file mode 100755 index 000000000..e543e3b48 --- /dev/null +++ b/src/main/flight/notch_table.h @@ -0,0 +1,102 @@ +float notch_table[][6] = { + { 3.500175e-03, 9.978056e-01, -1.995129e+00, 9.978056e-01, -1.995129e+00, 9.956112e-01 }, + { 7.000350e-03, 9.956208e-01, -1.989316e+00, 9.956208e-01, -1.989316e+00, 9.912416e-01 }, + { 1.050053e-02, 9.934455e-01, -1.982568e+00, 9.934455e-01, -1.982568e+00, 9.868910e-01 }, + { 1.400070e-02, 9.912796e-01, -1.974893e+00, 9.912796e-01, -1.974893e+00, 9.825592e-01 }, + { 1.750088e-02, 9.891230e-01, -1.966298e+00, 9.891230e-01, -1.966298e+00, 9.782461e-01 }, + { 2.100105e-02, 9.869758e-01, -1.956791e+00, 9.869758e-01, -1.956791e+00, 9.739515e-01 }, + { 2.450123e-02, 9.848376e-01, -1.946381e+00, 9.848376e-01, -1.946381e+00, 9.696753e-01 }, + { 2.800140e-02, 9.827086e-01, -1.935077e+00, 9.827086e-01, -1.935077e+00, 9.654173e-01 }, + { 3.150158e-02, 9.805887e-01, -1.922887e+00, 9.805887e-01, -1.922887e+00, 9.611773e-01 }, + { 3.500175e-02, 9.784776e-01, -1.909821e+00, 9.784776e-01, -1.909821e+00, 9.569552e-01 }, + { 3.850193e-02, 9.763754e-01, -1.895889e+00, 9.763754e-01, -1.895889e+00, 9.527509e-01 }, + { 4.200210e-02, 9.742820e-01, -1.881101e+00, 9.742820e-01, -1.881101e+00, 9.485641e-01 }, + { 4.550228e-02, 9.721974e-01, -1.865469e+00, 9.721974e-01, -1.865469e+00, 9.443948e-01 }, + { 4.900245e-02, 9.701213e-01, -1.849002e+00, 9.701213e-01, -1.849002e+00, 9.402427e-01 }, + { 5.250263e-02, 9.680539e-01, -1.831713e+00, 9.680539e-01, -1.831713e+00, 9.361078e-01 }, + { 5.600280e-02, 9.659949e-01, -1.813613e+00, 9.659949e-01, -1.813613e+00, 9.319898e-01 }, + { 5.950298e-02, 9.639444e-01, -1.794713e+00, 9.639444e-01, -1.794713e+00, 9.278888e-01 }, + { 6.300315e-02, 9.619022e-01, -1.775027e+00, 9.619022e-01, -1.775027e+00, 9.238044e-01 }, + { 6.650333e-02, 9.598683e-01, -1.754567e+00, 9.598683e-01, -1.754567e+00, 9.197366e-01 }, + { 7.000350e-02, 9.578426e-01, -1.733346e+00, 9.578426e-01, -1.733346e+00, 9.156852e-01 }, + { 7.350368e-02, 9.558250e-01, -1.711377e+00, 9.558250e-01, -1.711377e+00, 9.116501e-01 }, + { 7.700385e-02, 9.538156e-01, -1.688673e+00, 9.538156e-01, -1.688673e+00, 9.076311e-01 }, + { 8.050403e-02, 9.518141e-01, -1.665249e+00, 9.518141e-01, -1.665249e+00, 9.036282e-01 }, + { 8.400420e-02, 9.498205e-01, -1.641119e+00, 9.498205e-01, -1.641119e+00, 8.996411e-01 }, + { 8.750438e-02, 9.478349e-01, -1.616297e+00, 9.478349e-01, -1.616297e+00, 8.956698e-01 }, + { 9.100455e-02, 9.458570e-01, -1.590797e+00, 9.458570e-01, -1.590797e+00, 8.917140e-01 }, + { 9.450473e-02, 9.438869e-01, -1.564635e+00, 9.438869e-01, -1.564635e+00, 8.877738e-01 }, + { 9.800490e-02, 9.419245e-01, -1.537826e+00, 9.419245e-01, -1.537826e+00, 8.838489e-01 }, + { 1.015051e-01, 9.399697e-01, -1.510385e+00, 9.399697e-01, -1.510385e+00, 8.799393e-01 }, + { 1.050053e-01, 9.380224e-01, -1.482328e+00, 9.380224e-01, -1.482328e+00, 8.760448e-01 }, + { 1.085054e-01, 9.360826e-01, -1.453671e+00, 9.360826e-01, -1.453671e+00, 8.721652e-01 }, + { 1.120056e-01, 9.341502e-01, -1.424429e+00, 9.341502e-01, -1.424429e+00, 8.683005e-01 }, + { 1.155058e-01, 9.322253e-01, -1.394620e+00, 9.322253e-01, -1.394620e+00, 8.644505e-01 }, + { 1.190060e-01, 9.303076e-01, -1.364259e+00, 9.303076e-01, -1.364259e+00, 8.606152e-01 }, + { 1.225061e-01, 9.283971e-01, -1.333363e+00, 9.283971e-01, -1.333363e+00, 8.567943e-01 }, + { 1.260063e-01, 9.264939e-01, -1.301950e+00, 9.264939e-01, -1.301950e+00, 8.529878e-01 }, + { 1.295065e-01, 9.245978e-01, -1.270035e+00, 9.245978e-01, -1.270035e+00, 8.491955e-01 }, + { 1.330067e-01, 9.227087e-01, -1.237638e+00, 9.227087e-01, -1.237638e+00, 8.454174e-01 }, + { 1.365068e-01, 9.208267e-01, -1.204774e+00, 9.208267e-01, -1.204774e+00, 8.416533e-01 }, + { 1.400070e-01, 9.189516e-01, -1.171461e+00, 9.189516e-01, -1.171461e+00, 8.379032e-01 }, + { 1.435072e-01, 9.170834e-01, -1.137718e+00, 9.170834e-01, -1.137718e+00, 8.341668e-01 }, + { 1.470074e-01, 9.152220e-01, -1.103561e+00, 9.152220e-01, -1.103561e+00, 8.304441e-01 }, + { 1.505075e-01, 9.133675e-01, -1.069010e+00, 9.133675e-01, -1.069010e+00, 8.267350e-01 }, + { 1.540077e-01, 9.115196e-01, -1.034081e+00, 9.115196e-01, -1.034081e+00, 8.230393e-01 }, + { 1.575079e-01, 9.096785e-01, -9.987933e-01, 9.096785e-01, -9.987933e-01, 8.193570e-01 }, + { 1.610081e-01, 9.078440e-01, -9.631649e-01, 9.078440e-01, -9.631649e-01, 8.156879e-01 }, + { 1.645082e-01, 9.060160e-01, -9.272142e-01, 9.060160e-01, -9.272142e-01, 8.120320e-01 }, + { 1.680084e-01, 9.041946e-01, -8.909597e-01, 9.041946e-01, -8.909597e-01, 8.083891e-01 }, + { 1.715086e-01, 9.023796e-01, -8.544198e-01, 9.023796e-01, -8.544198e-01, 8.047592e-01 }, + { 1.750088e-01, 9.005710e-01, -8.176131e-01, 9.005710e-01, -8.176131e-01, 8.011420e-01 }, + { 1.785089e-01, 8.987688e-01, -7.805583e-01, 8.987688e-01, -7.805583e-01, 7.975376e-01 }, + { 1.820091e-01, 8.969729e-01, -7.432740e-01, 8.969729e-01, -7.432740e-01, 7.939459e-01 }, + { 1.855093e-01, 8.951833e-01, -7.057789e-01, 8.951833e-01, -7.057789e-01, 7.903666e-01 }, + { 1.890095e-01, 8.933999e-01, -6.680918e-01, 8.933999e-01, -6.680918e-01, 7.867998e-01 }, + { 1.925096e-01, 8.916226e-01, -6.302314e-01, 8.916226e-01, -6.302314e-01, 7.832452e-01 }, + { 1.960098e-01, 8.898515e-01, -5.922166e-01, 8.898515e-01, -5.922166e-01, 7.797029e-01 }, + { 1.995100e-01, 8.880864e-01, -5.540660e-01, 8.880864e-01, -5.540660e-01, 7.761728e-01 }, + { 2.030102e-01, 8.863273e-01, -5.157984e-01, 8.863273e-01, -5.157984e-01, 7.726546e-01 }, + { 2.065103e-01, 8.845742e-01, -4.774327e-01, 8.845742e-01, -4.774327e-01, 7.691484e-01 }, + { 2.100105e-01, 8.828270e-01, -4.389875e-01, 8.828270e-01, -4.389875e-01, 7.656541e-01 }, + { 2.135107e-01, 8.810857e-01, -4.004815e-01, 8.810857e-01, -4.004815e-01, 7.621715e-01 }, + { 2.170109e-01, 8.793503e-01, -3.619333e-01, 8.793503e-01, -3.619333e-01, 7.587005e-01 }, + { 2.205110e-01, 8.776206e-01, -3.233617e-01, 8.776206e-01, -3.233617e-01, 7.552411e-01 }, + { 2.240112e-01, 8.758966e-01, -2.847850e-01, 8.758966e-01, -2.847850e-01, 7.517932e-01 }, + { 2.275114e-01, 8.741783e-01, -2.462219e-01, 8.741783e-01, -2.462219e-01, 7.483567e-01 }, + { 2.310116e-01, 8.724657e-01, -2.076906e-01, 8.724657e-01, -2.076906e-01, 7.449314e-01 }, + { 2.345117e-01, 8.707587e-01, -1.692096e-01, 8.707587e-01, -1.692096e-01, 7.415174e-01 }, + { 2.380119e-01, 8.690572e-01, -1.307970e-01, 8.690572e-01, -1.307970e-01, 7.381145e-01 }, + { 2.415121e-01, 8.673613e-01, -9.247099e-02, 8.673613e-01, -9.247099e-02, 7.347226e-01 }, + { 2.450123e-01, 8.656708e-01, -5.424955e-02, 8.656708e-01, -5.424955e-02, 7.313416e-01 }, + { 2.485124e-01, 8.639858e-01, -1.615061e-02, 8.639858e-01, -1.615061e-02, 7.279715e-01 }, + { 2.520126e-01, 8.623061e-01, 2.180808e-02, 8.623061e-01, 2.180808e-02, 7.246122e-01 }, + { 2.555128e-01, 8.606318e-01, 5.960885e-02, 8.606318e-01, 5.960885e-02, 7.212636e-01 }, + { 2.590130e-01, 8.589628e-01, 9.723420e-02, 8.589628e-01, 9.723420e-02, 7.179256e-01 }, + { 2.625131e-01, 8.572990e-01, 1.346668e-01, 8.572990e-01, 1.346668e-01, 7.145981e-01 }, + { 2.660133e-01, 8.556405e-01, 1.718894e-01, 8.556405e-01, 1.718894e-01, 7.112810e-01 }, + { 2.695135e-01, 8.539872e-01, 2.088850e-01, 8.539872e-01, 2.088850e-01, 7.079744e-01 }, + { 2.730137e-01, 8.523390e-01, 2.456367e-01, 8.523390e-01, 2.456367e-01, 7.046779e-01 }, + { 2.765138e-01, 8.506959e-01, 2.821278e-01, 8.506959e-01, 2.821278e-01, 7.013917e-01 }, + { 2.800140e-01, 8.490578e-01, 3.183419e-01, 8.490578e-01, 3.183419e-01, 6.981156e-01 }, + { 2.835142e-01, 8.474248e-01, 3.542625e-01, 8.474248e-01, 3.542625e-01, 6.948496e-01 }, + { 2.870144e-01, 8.457968e-01, 3.898737e-01, 8.457968e-01, 3.898737e-01, 6.915935e-01 }, + { 2.905145e-01, 8.441737e-01, 4.251594e-01, 8.441737e-01, 4.251594e-01, 6.883473e-01 }, + { 2.940147e-01, 8.425555e-01, 4.601040e-01, 8.425555e-01, 4.601040e-01, 6.851110e-01 }, + { 2.975149e-01, 8.409422e-01, 4.946921e-01, 8.409422e-01, 4.946921e-01, 6.818843e-01 }, + { 3.010151e-01, 8.393337e-01, 5.289083e-01, 8.393337e-01, 5.289083e-01, 6.786674e-01 }, + { 3.045152e-01, 8.377300e-01, 5.627376e-01, 8.377300e-01, 5.627376e-01, 6.754600e-01 }, + { 3.080154e-01, 8.361311e-01, 5.961653e-01, 8.361311e-01, 5.961653e-01, 6.722621e-01 }, + { 3.115156e-01, 8.345368e-01, 6.291768e-01, 8.345368e-01, 6.291768e-01, 6.690737e-01 }, + { 3.150158e-01, 8.329473e-01, 6.617578e-01, 8.329473e-01, 6.617578e-01, 6.658946e-01 }, + { 3.185159e-01, 8.313624e-01, 6.938944e-01, 8.313624e-01, 6.938944e-01, 6.627249e-01 }, + { 3.220161e-01, 8.297822e-01, 7.255727e-01, 8.297822e-01, 7.255727e-01, 6.595643e-01 }, + { 3.255163e-01, 8.282065e-01, 7.567793e-01, 8.282065e-01, 7.567793e-01, 6.564130e-01 }, + { 3.290165e-01, 8.266353e-01, 7.875009e-01, 8.266353e-01, 7.875009e-01, 6.532707e-01 }, + { 3.325166e-01, 8.250687e-01, 8.177246e-01, 8.250687e-01, 8.177246e-01, 6.501374e-01 }, + { 3.360168e-01, 8.235065e-01, 8.474377e-01, 8.235065e-01, 8.474377e-01, 6.470131e-01 }, + { 3.395170e-01, 8.219488e-01, 8.766279e-01, 8.219488e-01, 8.766279e-01, 6.438976e-01 }, + { 3.430172e-01, 8.203955e-01, 9.052830e-01, 8.203955e-01, 9.052830e-01, 6.407910e-01 }, + { 3.465173e-01, 8.188465e-01, 9.333914e-01, 8.188465e-01, 9.333914e-01, 6.376931e-01 }, + { 3.500175e-01, 8.173019e-01, 9.609415e-01, 8.173019e-01, 9.609415e-01, 6.346039e-01 } +};