Mirror
/
ardupilot
mirror of https://github.com/ArduPilot/ardupilot
5
0
Fork 0
Code Issues Packages Projects Releases Wiki Activity

Filter: added test of phase lag vs attenuation

This commit is contained in:
Andrew Tridgell 2024-05-26 19:27:16 +10:00
parent f5a6193cbf
commit c908636cde
2 changed files with 44 additions and 0 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

12
libraries/Filter/tests/plot_harmonictest5.gnu Normal file
View File

@ -0,0 +1,12 @@
#!/usr/bin/gnuplot -persist
set y2tics 0,10
set ytics nomirror
set style data linespoints
set key autotitle
set datafile separator ","
set key autotitle columnhead
set xlabel "Attenuation(dB)"
set ylabel "PhaseLag(deg)"
set key left bottom
plot "harmonicnotch_test5.csv" using 1:2, "harmonicnotch_test5.csv" using 1:3, "harmonicnotch_test5.csv" using 1:4, "harmonicnotch_test5.csv" using 1:5, "harmonicnotch_test5.csv" using 1:6

32
libraries/Filter/tests/test_notchfilter.cpp
View File

@ -325,4 +325,36 @@ TEST(NotchFilterTest, HarmonicNotchTest4)
fclose(f);
}
/*
show phase lag versus attenuation
*/
TEST(NotchFilterTest, HarmonicNotchTest5)
{
const float min_attenuation = 0;
const float max_attenuation = 50;
const uint16_t steps = 200;
const char *csv_file = "harmonicnotch_test5.csv";
FILE *f = fopen(csv_file, "w");
fprintf(f, "Attenuation(dB),Lag(10Hz),Lag(20Hz),Lag(30Hz),Lag(40Hz),Lag(50Hz),Lag(60Hz),Lag(70Hz)\n");
for (uint16_t i=0; i<steps; i++) {
const float test_freq[7] { 10, 20, 30, 40, 50, 60, 70 };
float phase_lags[7];
float attenuations[7];
const float test_attenuation = min_attenuation + i*(max_attenuation-min_attenuation)/steps;
for (uint8_t F = 0; F < ARRAY_SIZE(test_freq); F++) {
test_one_filter(60, test_attenuation, 60, test_freq[F], 50, 1, 0,
phase_lags[F],
attenuations[F]);
}
fprintf(f, "%.3f,%f,%f,%f,%f,%f,%f,%f\n",
test_attenuation,
phase_lags[0], phase_lags[1], phase_lags[2],
phase_lags[3], phase_lags[4], phase_lags[5],
phase_lags[6]);
}
fclose(f);
}
AP_GTEST_MAIN()