src/target/firmware/layer1/avg.c

   1 /* Averaging Implementation */
   2
   3 /* (C) 2010 by Harald Welte <laforge@gnumonks.org>
   4  *
   5  * All Rights Reserved
   6  *
   7  * This program is free software; you can redistribute it and/or modify
   8  * it under the terms of the GNU General Public License as published by
   9  * the Free Software Foundation; either version 2 of the License, or
  10  * (at your option) any later version.
  11  *
  12  * This program is distributed in the hope that it will be useful,
  13  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  14  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  15  * GNU General Public License for more details.
  16  *
  17  * You should have received a copy of the GNU General Public License along
  18  * with this program; if not, write to the Free Software Foundation, Inc.,
  19  * 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA.
  20  *
  21  */
  22
  23 #include <stdint.h>
  24
  25 #include <layer1/avg.h>
  26
  27 /* input a new sample into the averaging process */
  28 void runavg_input(struct running_avg *ravg, int32_t val, int valid)
  29 {
  30         ravg->num_samples++;
  31         if (valid) {
  32                 ravg->acc_val += val;
  33                 ravg->num_samples_valid++;
  34         }
  35 }
  36
  37 /* check if sufficient samples have been obtained, and call outfn() */
  38 int runavg_check_output(struct running_avg *ravg)
  39 {
  40         if (ravg->num_samples < ravg->period)
  41                 return 0;
  42
  43         if (ravg->num_samples_valid >= ravg->min_valid) {
  44                 int32_t avg = ravg->acc_val / ravg->num_samples_valid;
  45
  46                 ravg->outfn(ravg, avg);
  47
  48                 ravg->num_samples = ravg->num_samples_valid = 0;
  49                 ravg->acc_val = 0;
  50
  51                 return 1;
  52         }
  53
  54         return 0;
  55 }
  56
  57