net/batman-adv/ring_buffer.c

   1 /*
   2  * Copyright (C) 2007-2012 B.A.T.M.A.N. contributors:
   3  *
   4  * Marek Lindner
   5  *
   6  * This program is free software; you can redistribute it and/or
   7  * modify it under the terms of version 2 of the GNU General Public
   8  * License as published by the Free Software Foundation.
   9  *
  10  * This program is distributed in the hope that it will be useful, but
  11  * WITHOUT ANY WARRANTY; without even the implied warranty of
  12  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
  13  * General Public License for more details.
  14  *
  15  * You should have received a copy of the GNU General Public License
  16  * along with this program; if not, write to the Free Software
  17  * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA
  18  * 02110-1301, USA
  19  *
  20  */
  21
  22 #include "main.h"
  23 #include "ring_buffer.h"
  24
  25 void batadv_ring_buffer_set(uint8_t lq_recv[], uint8_t *lq_index,
  26                             uint8_t value)
  27 {
  28         lq_recv[*lq_index] = value;
  29         *lq_index = (*lq_index + 1) % TQ_GLOBAL_WINDOW_SIZE;
  30 }
  31
  32 uint8_t batadv_ring_buffer_avg(const uint8_t lq_recv[])
  33 {
  34         const uint8_t *ptr;
  35         uint16_t count = 0, i = 0, sum = 0;
  36
  37         ptr = lq_recv;
  38
  39         while (i < TQ_GLOBAL_WINDOW_SIZE) {
  40                 if (*ptr != 0) {
  41                         count++;
  42                         sum += *ptr;
  43                 }
  44
  45                 i++;
  46                 ptr++;
  47         }
  48
  49         if (count == 0)
  50                 return 0;
  51
  52         return (uint8_t)(sum / count);
  53 }