Blame view

net/batman-adv/ring_buffer.c 1.22 KB
c6c8fea29   Sven Eckelmann   net: Add batman-a...
1
  /*
64afe3539   Sven Eckelmann   batman-adv: Updat...
2
   * Copyright (C) 2007-2011 B.A.T.M.A.N. contributors:
c6c8fea29   Sven Eckelmann   net: Add batman-a...
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
   *
   * Marek Lindner
   *
   * This program is free software; you can redistribute it and/or
   * modify it under the terms of version 2 of the GNU General Public
   * License as published by the Free Software Foundation.
   *
   * 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 "main.h"
  #include "ring_buffer.h"
  
  void ring_buffer_set(uint8_t lq_recv[], uint8_t *lq_index, uint8_t value)
  {
  	lq_recv[*lq_index] = value;
  	*lq_index = (*lq_index + 1) % TQ_GLOBAL_WINDOW_SIZE;
  }
747e4221a   Sven Eckelmann   batman-adv: Add c...
30
  uint8_t ring_buffer_avg(const uint8_t lq_recv[])
c6c8fea29   Sven Eckelmann   net: Add batman-a...
31
  {
747e4221a   Sven Eckelmann   batman-adv: Add c...
32
  	const uint8_t *ptr;
c6c8fea29   Sven Eckelmann   net: Add batman-a...
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
  	uint16_t count = 0, i = 0, sum = 0;
  
  	ptr = lq_recv;
  
  	while (i < TQ_GLOBAL_WINDOW_SIZE) {
  		if (*ptr != 0) {
  			count++;
  			sum += *ptr;
  		}
  
  		i++;
  		ptr++;
  	}
  
  	if (count == 0)
  		return 0;
  
  	return (uint8_t)(sum / count);
  }