Median filter has an advantage over moving average that it is much less sensitive to outliers. For instance, it allows much faster recovery from an external clock time step which happened between receiving sync message and sending delay_req message. The measured delay includes a large error, but the median is still a good estimate of the delay and the first step correction applied by the servo is right. In this implementation the median update has linear time complexity. Signed-off-by: Miroslav Lichvar <mlichvar@redhat.com>
50 lines
1.3 KiB
C
50 lines
1.3 KiB
C
/**
|
|
* @file filter.c
|
|
* @note Copyright (C) 2013 Miroslav Lichvar <mlichvar@redhat.com>
|
|
*
|
|
* This program is free software; you can redistribute it and/or modify
|
|
* it under the terms of the GNU General Public License as published by
|
|
* the Free Software Foundation; either version 2 of the License, or
|
|
* (at your option) any later version.
|
|
*
|
|
* This program is distributed in the hope that it will be useful,
|
|
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
|
* GNU General Public License for more details.
|
|
*
|
|
* You should have received a copy of the GNU General Public License along
|
|
* with this program; if not, write to the Free Software Foundation, Inc.,
|
|
* 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA.
|
|
*/
|
|
|
|
#include "filter_private.h"
|
|
#include "mave.h"
|
|
#include "mmedian.h"
|
|
|
|
struct filter *filter_create(enum filter_type type, int length)
|
|
{
|
|
switch (type) {
|
|
case FILTER_MOVING_AVERAGE:
|
|
return mave_create(length);
|
|
case FILTER_MOVING_MEDIAN:
|
|
return mmedian_create(length);
|
|
default:
|
|
return NULL;
|
|
}
|
|
}
|
|
|
|
void filter_destroy(struct filter *filter)
|
|
{
|
|
filter->destroy(filter);
|
|
}
|
|
|
|
tmv_t filter_sample(struct filter *filter, tmv_t sample)
|
|
{
|
|
return filter->sample(filter, sample);
|
|
}
|
|
|
|
void filter_reset(struct filter *filter)
|
|
{
|
|
filter->reset(filter);
|
|
}
|